MODELLING, SIMULATION AND DAMPING OF 
FLEXIBLE MANIPULATORS 


By 

Ankur Gupta 



department of mechanical engineering 

Indian Institute of Technology Kanpur 

APRIL, 2002 



MODELLING, SIMULATION AND DAMPING OF 
FLEXIBLE MANIPULATORS 


A Thesis Submitted 

In Partial Fulfilment of the Requirements 
for the Degree of 
Master of Technology 


by 

ANKUR GUPTA 



to the 

DEPARTMENT OF MECHANICAL ENGINEERING 

INDIAN INSTITUTE OF TECHNOLOGY KANPUR 

INDIA 

April, 2002 



5 FEB 2003 / 

^Tf^ni'4 wlv.ljyiCf ^r^srr?! 

„ . * 141936 

anrrfccT a — .-« rJ:-:.f!L«. 



CERTIFICATE 



It is certified that the work contained in the thesis entitled- ‘^Modelling, Simulation 
and Damping of Flexible Manipulators'’ , Mr. Ankur Gupta , has been carried 
out under our supervision and that this work has not been submitted elsewhere for a degree. 


Dr. Bishakh I^attacharya 
Asst. Professor 

Dept, of Mechanical Engineering 
I.I.T Kanpur 


Dr. Bhaskar Dasgupta 
Asst. Professor 

Dept, of Mechanical Engineering 
I.I.T. Kanpur 


April, 2002 



Acknowledgements 

I would like to express my deep sense of gratitude towards my thesis supervisors Dr. 
B. Bhattacharya and Dr. B. Dasgupta for their excellent guidance, invaluable suggestions 
and generous help at all stages of my research work. Their interest and confidence in me 
was the main reason for all the success I have made. 

I am greatly indebted to all my teachers for their endeavour to make me learn as much 
as possible. In particular I would like to thank Dr. P. M. Dixit for his guidance in solving 
the system of non-linear equations. 

I am thankful to Dr. Amitabha Mukharjee for extending me the facilities of Centre for 
Robotics for the completion of this work. It was pleasure to be associated with the Centre 
for Robotics and I would like to thank staff at Centre for Robotics for making it a place to 
work in. 

I am extremely grateful to my Robotics Lab mates Shamik, Kaushik, Pavan and Gaurav 
for all the encouragement and support I have received from them at all times. 

And lastly, I thank all my friends for making my stay at I.I.T. Kanpi.r enjoyable and 
memorable one. 


Ankur Gupta 



Dedicated to My Parents and Teachers 



Abstract 


A flexible robot is characterized by its lightweight and highly flexible joints and links. 
Therefore it responds to the gross motion of links in the form of undesirable vibration. In 
this thesis an effort has been made to counter this problem by modelling and damping of 
single-link and two-link planer robots with rotary joints. In this work bending and axial 
deformation of the flexible links are considered using Euler Bernoulli beam theory. To 
model a flexible robot link, which is essentially a continuous system, it is discretized by 
using finite element method. Compared to other methods, like assumed mode method, this 
method is of particular advantage as boundary conditions and physical properties may be 
imposed in the traceable and natural manner while deriving the equations of the motion. 
After finding the expression for displacement at any point using finite element method, 
the dynamic equations of motion are derived using Lagrangian formulation. For complex 
dynamic systems, like the flexible link manipulator system where mass and elasticity are 
distributed over the finite regions, it is easier to derive the equations of motion by using 
Lagrange’s method. In the case of two-link manipulator, the effect of flexibility of first 
link on the generalized position of any point on second link is considered by incorporating 
the tip-deflection of first link in the transformation matrix between the two links and after 
getting the sets of dynamic equations for two links, they are solved simultaneously to 
get the solutions. Time response results are obtained for undamped and viscous damped 
systems. Finally each of the link is modeled as a typical laminated composite beam made 
up of number of layers of passive damping coating and a magnetostrictive material. A 
combined passive and active damping strategy in hybrid mode using combination of layers 
of ferromagnetic (passive) and smart (active) magnetostrictive (Terfenol-D) materials is 
proposed. 
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Chapter 1 
Introduction 


1.1 Introduction 

The studies on the robot systems till recent years were confined to rigid robots. Here the 
term rigid robot refers to the robots, which can be modeled using rigid body dynamics. 
This assumption is fairly acceptable for typical industrial robots having slow movement 
with heavy and bulky arm structural design. Consequently they are limited to low load 
carrying capacity (typically 5 to 10 percent of their own weight) by the requirements of 
their rigidity. Rigid robots, with all these features exhibit good repeatability and accuracy 
with ease in design (Fi-aser and Anthony 1991). 

With the advancement in actuator technology coupled with new designs, such as direct- 
drive arms, have led to rapid increase in the speed and load carrying capacity of the robots. 
Also, with the extension of robot applications to newer fields like in space, medical surgery 
etc., light weight and high flexibility of robot arms have become important factors in the 
design and put additional constraints on the rigid robots. 

All these have led to the greater need of considering flexibility of nominally rigid links 
of a robot. However, as the assumption of rigid links is relaxed, the rigid body dynamics 
no longer remains applicable which consequently opens a completely new area of research, 
called flexible robots. 

1.2 Advantages of Flexible Robots 

Apart from the factors which requires the use of flexible links and light weight of robots 
there are several other features of flexible robots viewed as the potential advantages for 
industry and other applications. 

1. Lower energy consumption - lighter links and in turn lighter joints have lower inertia 
which leads to less power consumption to produce same acceleration for a constant 
payload capacity. 



2. Smaller actuators - to move lighter arms and joints smaller and cheaper actuators 
can be used. 

3. Less bulky design - trimmer arm design leads to a more compact and lightweight 
robot. 

4. Compliant structure - mechanical compliance can be achieved by the use of flexible 
arms and joints. This is particularly useful in delicate operations like surgical robots, 
some assembly operation etc where arms themselves act as the forcr/torque-sensing 
device. 

5. Faster in operation and better maneuverability - with high speed they are partic- 
ularly helpful in increasing the productivity in an industry. Due to their lighter 
weight flexible robots are easy to maneuver without exerting much load on joints and 
actuators. 

6. Safer operation - due to compact design and lightness in structure they cause lesser 
damage in case of any accident. 

1.3 Problems Associated with Flexible Robots 

Unfortunately, if the flexibility of a manipulator link is considered the modelling of the 
system as well as equations describing the dynamics become more complex. In addition to 
gross motion of the arms, the deformation behavior of the individual links has to be taken 
into account. The deformation behavior is exhibited in the form of undesirable vibrations 
at the tip of the links. The two effects interact with each other further complicating the 
system dynamics. Some other problems faced by flexible manipulators are as follows: 

1.3.1 Phase lag 

As observed the propagation speed of the elastic deformation waves in a flexible link is finite 
and this normally gives rise to a phase lag between control input and sensor output when 
an actuator and sensor are non-collocated (Spector and Flashner 1990). Further this phase 
lag is observed to be frequency dependent. In case of a single flexible link, if the sensor and 
actuator are collocated there is no phase lag. Nonetheless, in a multi-link case the phase 
problems are much more complex. Even when an actuator and sensor are collocated, there 
may be phase lag, because of phase delayed disturbances due to the motion of other links. 

1.3.2 Spillover 

In a flexible manipulator each link is a continuous system and is defined by infinite degrees 
of freedoms, however for control purpose usually the system is considered as a combination 



of finite number of lumped masses making the controller a finite dimensional system. In 
order to discretize the continuous system using independent modal space control, the high 
frequency terms are usually truncated. As a result the neglected higher frequency mode 
terms interact with the feedback control loop, causing the system instability. This is referred 
as the Spillover problem (Balas 1982). 

1.3.3 Effect of Payload and Nonlinear Terms 

As mentioned earlier, flexible manipulators have high payload to robot weight ratio which 
signifies that the payload weight becomes considerable as compared, to the robot weight 
and can no longer be neglected as in case of rigid robots. However with the inclusion 
of the payload dynamics into manipulator model the inertia of the link gots considerably 
changed and with that also changes the flexible modes of vibration. Another feature of 
flexible manipulators is that they typically have high-speed motions unlike the slow move- 
ments of rigid robots. Due to its high speed the velocity dependent nonlinear terms like 
centrifugal and coriolis force terms, becomes considerably large and neglecting them in the 
system model causes the error in the dynamics and leads to numerical instability in system 
simulation (Rex 1995). 

1.3.4 Flexible-Link with Prismatic Joints 

In the case of flexible manipulators with prismatic joints the effective length of flexible arm 
changes with time and spatial domain no longer remains fixed. It has been observed that 
extending and contracting motions of arms have destabilizing and stabilizing effect on the 
vibratory motions respectively (Wang and Wie 1987). Flexible beams with payload gives 
rise to a moving boundary value problem with time varying boundary conditions which 
leads to time dependent modal functions and modal frequencies of flexible links, further 
complicating the system. 

1.4 Literature Survey 

In a flexible manipulator, the flexibility is due to both link and joint elasticity. However 
the effect of eacli is mainly dependent on the manipulator geometry. It has been observed 
that for manipulator with long, thin and lightweight links, flexure of manipulator link plays 
considerable role, therefore in pr^ent thesis only the effect due to link flexibility has been 
considered. Related work done by various researchers is reviewed and has been presented 
in the following sections. 



1.4.1 Modelling of the System 


A flexible manipulator being a continuous dynamics system has infinite degrees of freedom 
and is governed by the coupled-nonlinear-partial differential equations. Finding the solu- 
tion of such a system is extremely difficult, particularly as we move onto multi-link cases. 
Besides this other practical constraints like finite dimensional actuators and sensors make 
it necessary to discretize the system while finding the system dynamics equations. 

In past mainly two types of discretization methods have been employed by the re- 
searchers namely assumed mode method and finite element method. In assumed mode 
method the flexible displacements of each link axe expressed as summation of finite number 
of assumed mode terms. Each mode term is product of mode shape function, which is 
purely a function of displacement along link and time dependent modal amplitude. As- 
sumed mode method greatly improves the efficiency of the final algorithm (Fraser and 
Anthony 1991). Further it has been found that with increase of mode number the inertia 
matrix tends to become ill posed (Yan, Meng and Wang 1999). 

In finite element method, unlike assumed mode method, each of the fiexible links is 
considered as an assemblage of finite number of elements, where each element satisfies the 
required continuity and convergency condition (Zienkiewicz 1986). Further a joint-beam 
element for revolute joint manipulators can be proposed for planer (Yue, Yu and Bai 1997) 
as well as for spatial flexible manipulator (Zhang and Yu 1999). Since the displacement at a 
junction point (Node) of any two elements is same for both the elements the internal forces 
axe balanced so that after assembly we get the model of complete link. Similar to assumed 
mode method the flexible displacement at any point is expressed as summation of terms 
containing the product of polynomial shape functions (different for different continuity 
requirements) and time dependent nodal displacements. Owing to simplicity of the shape 
functions, which are local in nature, less number of mathematical operations axe required 
for inertia matrix computation as compared to that in case of assumed mode method (Rex 
1995). However main advantage of this method lies in the traceable and natural manner in 
which the boundary conditions and physical properties may be imposed while deriving the 
equations of the motion (Badoor and Almusallam 1999). All these factors have encouraged 
the wide use of this method in modelling of the flexible manipulator (Usoro, Ndira and 
Mahil 1986; Petrie 1995; Gamarra and Yuhara 1999). 

After finding the expression for displacement at any point using any of the discretization 
method the equations of motion are derived using either of Lagrangian formulation or 
Newton-Euler formulation. In case of the Lagrangian formulation, firstly the total kinetic 
and potential energies are found for each link in terms of flexible degrees of freedom and joint 
variables. Subsequently the standard Lagrange’s equation is applied to get the dynamic 
equations (Meirovitch 1967). It has been observed that in complex dynamic systems, 
particularly the flexible links manipulator system where mass and elasticity are distributed 



over the finite regions. It is easier to derive the equations of motion by using Lagrange’s 
method (Rex 1995). Therefore in this thesis Lagrangian formulation has been used to 
derive the dynjimic equations of motion. 

Another approach for finding the dynamic equations is by application of Newton-Euler 
model. In the case of rigid manipulator, Newton-Euler model have given the best results to 
solve the simulation and control problems, as far as time consumption and programming 
simplicity are concerned. This fact has encouraged many researchers to extend this method 
for flexible manipulators. The basic approach in Newton-Euler/finite element method is 
to divide the arm into number of elements and carry out a dynamic balance on each 
element. However, for a large number of elements clearly it is a tedious process (Eraser and 
Daniel 1991). Generalized Newton-Euler model based on the principle of virtual power and 
formalism of description of motion has been found to provide a fast recursive simulation 
algorithm (Boyer and Coiffet 1996). 

Damping is another important aspect, which requires to be considered in the modelling 
of a flexible system. Every elastic system inherently exhibits some amount of natural 
damping which has seldom been considered by the researchers. Although the appropriate 
damping can only be modelled by experiments (Book 1993), Rayleigh Damping has been 
found to give good results with experimentally determined damping coefficients (Petrie 
1995). 

1.4.2 Control of Flexible Manipulators 

The purpose of control is to maintain the dynamic response of the system in accordance 
with given performance criterion. The main problem in the control of a rigid manipulator 
is that the manipulator dynamics is highly nonlinear and complex (Pu, Gonzalez and Lee 
1987). In the case of flexible manipulator, design of controller becomes extremely difficult 
as flexible arms respond to gross link motion in the form of undesirable vibrations. Now 
the controller has to do an additional task of suppressing the flexible arm vibration along 
with joint position control. Various passive damping and active damping schemes have been 
proposed in the past research. Passive Damping of structures, especially using layers of soft 
viscoelastic or hard ceremics having high damping characteristics, has attracted extensive 
attention. Some ceremics and ferromagnetic coatings yield significant structural damping 
which depends on the strain induced in the material (Bhattacharya, Vidyashankar and 
Tomlinson 2000). Smart materials like piezoelectric materials have been used successfully 
for controlling the single link (Dong and Mills 1999) and two-link planer manipulators (Ho 
and Seung 2001). Other smart materials like Terfenol-D have shown good potential for 
active damping. A combined passive and active damping using combination of layers of 
ferromagnetic (passive) and smart (active) magnetostrictive material in hybrid mode has 
been propc^ed to control vibration (Bhattacharya, Vidyashankar and Tomlinson 2000). 



1.5 Motivation 


As discussed iu Section 1.2 flexible manipulators possess several features, which make the 
modelling of the manipulator quite difficult, and give rise to system defined by extremely 
complex dynamic equations. In addition to this, formulating a satisfactory control strategy 
has emerged as another big challenge. Thus, inspite of great advantages (discussed in 
Section 1.1) the application of flexible manipulator has been quite limited. All these factors 
have interested many researchers to solve the problem of modelling and control of flexible 
manipulators in a systematic manner. This is also the motivation for current thesis. 

1.6 Thesis Objectives and Contributions 

The main objectives of this thesis are as follows: 

• Firstly, to model a flexible single link manipulator having revolute joint, considering 
the link flexibility, and then to derive the dynamic equations of motion for this model. 

• Secondly, to incorporate the appropriate damping to reduce the vibrations and thereby 
to minimize the error at the end effector. 

• Thirdly, to extend the work of modelling, derivation of system dynamic equations 
and damping to a two-link planer flexible manipulator having revolute joints only. 

With this in mind the main contributions of the thesis can be summarized in the following: 

1. To model a flexible single link manipulator, which is essentially a coi.tinuous system, 
it is discretized by using finite element method. Then Lagrangian formulation is 
employed to derive the dynamic equations. 

2. Damping of link vibration is assumed to be viscous damping and included in the 
system model. Results have shown it to suppress the link vibrations effectively. 

3. In addition a combined passive and active damping strategy using combination of 
layers of ferromagnetic (passive) and smart (active) magnetostrictive (Terfenol-D) 
materials is proposed in hybrid mode. 

4. A two link flexible manipulator is modelled by considering the effect of flexibility 
of first (shoulder) link on the dynamics of second (elbow) link by modifying the 
transformation matrix between the two links. In this case also, while deriving the 
system dynamics equations, damping is considered. 



1.7 Thesis Organization 


In Chapter 2, a general scheme based on Lagrangian formulation is presented to derive the 
equations of motion of a multi-link planer flexible as well as rigid manipulator with rotary 
joints. In case of flexible links finite element method is used to discretize the continuous 
system. With this proportional and hybrid damping are discussed. In Chapter 3, dynamic 
equations of motion are derived for a single link rigid and flexible manipulators on the basis 
of formulation discusses in Chapter 2. After that time response results are discussed for 
undamped and damped cases. In Chapter 4, the work is extended to two-link rigid and 
flexible manipulators cases. After deriving the equations time response results are discussed 
for undamped and damped cases. Finally in Chapter 5, we summarize the work and give 
suggestions for future work. 



Chapter 2 

Robot Arm Dynamics 


In this chapter, firstly a general scheme, based on the Lagrangian formulation is presented 
to derive the dynamic equations of motion for a multi-link planer robot having rigid joints 
and links. In Section 2.2, Lagrange’s equation in conjunction vdth finite element method 
is used to develop the equations of motion for a multi-link robot having flexible links. 
Finally proportional and hybrid damping schemes are discussed and are incorporated into 
the model. 


2.1 Dynamics of Rigid Robot Arm 


To start with, we consider the dynamics of a multi-link planer robot, assuming the joints and 
arms to be rigid. The general equations of motion are found through the direct application 
of the Lagrangian formulation to a non-conservative system (Fu, Gonzalez and Lee 1987). 
The Lagrange’s equation is given as: 


1 

dt V^q/ 



(2.1) 


where £= Lagrangian function = Kinetic Energy (T) - Potential Energy (V) 
q = Generalized coordinates of the robot arms 
q = Time derivative of generalized coordinates, q 
Q= Generalized force (or torque) applied to the system 
Dynamic formulation of a rigid robot is presented in the following secti 3 n. 


2.1.1 Planer Manipulator Kinematics 

As suggested by Equation 2.1, Lagrangian formulation requires the knowledge of kinetic 
energy of the manipulator, which in turn requires the knowledge of the velocity of each 
link. In this section, the velocity at a point on link j is derived. Figure 2.1 shows the 
schematic of a multi-link planer manipulator. ‘ 



Link j 



Figure 2.1: Schematic of a multi-link planer manipulator 

Position vector of a point on link j in local coordinate frame {Xj, Yj), rj is given by: 

= [ a: y 1 (2-2) 

Therefore position vector of a point on link j in with respect to base coordinate frame 
(Xo, To), rj is given by: 

rj = (2-3) 

and 




(2.4) 


where 72.^“’ is homogeneous coordinate transformation matrix from coordinate system 
{Xj-i, Yj-i) to {Xj, Yj) and is given by: 




-1 


cos 9j — sin 9j Lj^i cos 9j 
sin 9i cos 9j L,_i sin 9j 


(2.5) 

^ I 

0 0 1 

Where Lj^i is the length of the (j - l)th link and 9j is the angle between {j - l)th and 
jth coordinate frame. Now the velocity at a point on link j with respect to base frame, ij 
is given by: 


a7^? 





2.1.2 Kinetic Energy of Manipulator 

Let dTj be the kinetic energy of a differential mass dm in the link j, then 

dTj = = ^trace(Tpf) 

Prom Equation 2.6, substituting the value of we get, 


(2.7) 


dTi 


tr 


^anl .(4.dnl 


dm 


-tr 




( 2 . 8 ) 


Integrating to get the total kinetic energy of link j 

3 3 0 


Tj = Itr 
^ 2 


r 

a<h \J 






(2.9) 


The integral term inside the bracket is defined as Pseudo inertia matrix {Jj) of all points 
on link j and is given by: 


Ji 


1^4 


dm 


J Xjdm f XjUjdm J xjdm 
f xjyjdm J y]dm J yjdrn 
[ J Xjdm J yjdm J dm J 


(2.10) 


Finally total kinetic energy of manipulator can be found by summing over n links: 


, n J J 
1 

j:szl pzzl r=l 


T 


aq/M 5q, 


qpqr 


( 2 . 11 ) 


2.1.3 Potential Energy of Manipulator 

In case of a horizontal planer manipulator the gravitation potential energy remains con- 
stant, therefore all its derivatives are zero, i.e. 

aq ~ aq “ ^ 

hence there is no need of calculating the potential energy. 


( 2 . 12 ) 


2.1.4 Equations of Motion of a Rigid Robot 

Prom Equations 2.11 and 2.12, the Lagrangian function C — T — V is given by, 


n J 3 

JLmJ JmmmJ JLmJl 
j'ssl p=l r=l 


(en]' 


q.qr 


(2.13) 



Applying Lagrange’s equation yields 

d fdC\ dC 
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dt \dqj dq 
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+ EEE 
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For j = 1, 2, . . . , n above equations can be expressed in the following form: 

n n n 

Qi = y ^ DjJfcqjfc + EE 


k=l 


fc=l m=l 


or in matrix notation form as 


where: 


D(q(^))q(i) + h(q(t),q(t)) = Q{t) 
_ f&R^i j f&RA'^y 

h - = fr( 7 . ( 


(2.14) 


(2.15) 


(2.16) 

(2.17) 

(2.18) 


2.2 Dynamics of Multi-Link Flexible Manipulators 

A manipulator having flexible links is a continuous dynamic system and therefore has in- 
finite degrees of freedom whicli is governed by coupled-nonlinear-partial differential equa- 
tions. However, for a major part of the engineering purposes, a mathematical model should 
be of finite order. It has been observed that finding the solution of an infinite order system 
is increasingly difficult or impossible in many cases for e.g. system with complex boundary 
conditions etc. Moreover certain practical constraints like finite dimensional actuators and 
sensors make it necessary to discretize the flexible links. 

The flexible links may be decritized by using the assumed mode method or finite element 
method. In the assumed mode method, flexible displacements of each link are expressed 
as summation of finite number of modal functions. Each term is product of mode shape 
function, which is a function of displacement along link and time dependent modal am- 
plitude. In the case of finite element method, unlike assumed mode method each of the 
flexible link is considered as an assemblage of finite number of elements, where each element 
satisfies the required continuity and convergency conditions (Zienkiewicz 1986). Since the 
displacement at a junction point (Node) of any two elements is same for both the elements, 



the internal forces are balanced so that after assembly we get the model of complete link. 
Similar to assumed mode method the flexible displacement at any point may be expressed 
as summation of terms containing the product of polynomial shape functions (different for 
different continuity requirements) and time dependent nodal displacements. 

It has been observed that in the field of flexible manipulator system assumed mode 
method is more common and finite element method has been somehow disregarded. This 
is probably due to greater model enlargement in case of finite element modelling i.e. the 
number of state space equations are more which causes the numerical simulation to take 
more time compared to the assumed mode method. However owing to simplicity of the 
shape functions, which are local in nature, less number of mathematical operations are 
required for inertia matrix computation as compared to that in case of assumed mode 
method (Rex 1995). The main advantage of finite element method lies in the traceable 
and natural manner in which the boundary conditions and physical properties may be 
imposed while deriving the equations of the motion. Hence it is easier to solve complicated 
problems with different discontinuities of material and shape. Therefore in current work 
finite element method has been used for the modelling of the flexible arm. 

After finding the expression for displacement at any point using any of the discretiza- 
tion method, the dynamic equations of motion can be derived using either of Lagrangian 
formulation or Newton-Euler formulation. The basic approach in Newton-Euler/finite el- 
ement method is that the arm is divided into number of elements and a dynamic balance 
on each element is carried out. However, for a large number of elements clearly it is a 
tedious process (Eraser and Daniel 1991). In case of Lagrangian formulation, firstly the 
total kinetic and potential energies are found for all the links in terms of flexible degrees 
of freedom and joint variables. Then standard Lagrange’s equation is applied to get the 
dynamic equations of motion (Meirovitch 1967). It has been observed that in the case of 
complex dynamic systems like flexible links manipulator system where mass and elasticity 
are distributed over the finite regions, it is easier to derive the equations of motion by using 
Lagrange’s method (Rex 1995). Therefore in this thesis Lagrangian formulation has been 
used to derive the dynamic equations of motion. 

2.2.1 Assumptions 

In this thesis, basic assumptions for modelling of a flexible manipulator are as follows: 

1. Links of the manipulator are equivalent to Euler-Bemoulli beam and axial deforma- 
tion has been considered during modelling. 

2. Bending occurs in one plane. 

3. Links are axially symmetric in absence of deformation. 



4. Torsional deformations are neglected. 

5. Joints are considered to be rigid. 


2.2.2 Modelling Procedure 

The main objective of the methodology is to derive the dynamic equations of motion in a 
compact symbolic form. Basic procedure involves the following steps: 

1. Division of manipulator link into a number of finite elements of equal length. 

2. Calculation of elemental kinetic energy and potential energy. 

3. Assembly to get the total kinetic and potential energies for the manipulator. 

4. Application of boundary conditions. 

5. Application of Lagrange’s equation . 


2.2.3 Link Kinematics 


By convention the links of a planer revolute joint manipulator are numbered consecutively 
from 0 to n starting from base of the manipulator to tip of the end-effector, where n is the 
total number of links. We define the coordinate system {Xj, Yj) on link j with origin Oj at 
joint jf, oriented so that the Xj axis is along the axis of link j. The 2x2 rotation matrix 
from coordinate system to {Xj,Yj), is given by (Craig 1999): 



cos 9j — sin 9j 
— sin 6j cos Oj 


(2.19) 


where 

~ 4^3-1, tip 

Oj : Angle between {j — l)th and jth links 

(i>j-i,tip : Angular deflection at the tip (farthest point from base) of the {j - l)th link 
Let TZj be the 2 x 2 rotation matrix from the base coordinate system (Xq, Yq) to {Xj, Yj) 
then: 

71° = (2.20) 

Using this matrix, the position vector of any material pomt(s) along the neutral axis of 
link j can be expressed with respect to base coordinate system (Xo,io) as : 


r° = p9 + n^j 


( 2 . 21 ) 



Where p° is a 2 x 1 position vector of base point (at jth joint) of jth link with respect to 
base coordinate system. And the local position vector rj- is given by: 




Uj (x, t) 
Vj(x,t) 


( 2 . 22 ) 


where 

Uj{x,t) : axial deformation along W-axis at a distance x and at time t expressed in 
coordinate frame of link j 

Vj{x,t) : flexural transverse deflection along Y-axis with reference to neutral axis at a 
distance x and at time t expressed in coordinate frame of link j 

The velocity of a material point on link j can be obtained from the time derivative of 
the inertial base frame and is given by: 


Where fj is given by: 




0 

Vj{x,t) 


(2.23) 

(2.24) 



Figure 2.2: A typical finite element i in link j 

2.2.4 Discretization 

As discussed in Section 2.2, we use finite element method to discritize the flexible links. 
Each of the links is divided into a number of finite elements of equal lengths. Let PQ be 
one such element i on link j, with nodes i and i -t- 1 as shown in Figure 2.2. 



Local position vector of any point along the neutral axis of the ith element, expressed 
in local coordinate system is given by: 


+ Xji 

0 


Vj^{x,t) 


(2.25) 


Where Ij is the length of each element of link j and expression for elastic displacements 
Uji{x,t) and Vji{x,t) are given as: 


' Uji{x,t) ] ^ \ Fi{x) 0 0 F 2 {x) 0 0 In 

Vjiix,t) \ [ 0 Hi{x) H 2 {x) 0 Hz{x) ^ 

and vector of elemental flexible degrees of freedom, (t) is given by: 

]' (2.27) 


q*,(<) ( 2 . 26 ) 


where 

Uj^i{t) : axial deformation along X-axis at ith node of jth link 

Vj^i{t) : flexural transverse deflection along Y-axis at ith node of jth li,.ik 

vxj^i(t) : flexural slope along Y-axis at ith node of jth link 

A typical link element ‘i’ with its nodal degrees of freedoms has been shown in Figure 2.3. 



Node i Node i+1 


Figure 2.3: Nodal degrees of freedoms of ith element of link j 


Various shape functions are given as (Zienkiewicz 1986): 
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( 2 . 28 ) 


2.2.5 Calculation of Kinetic and Potential Energies 

Kinetic Energy 

The total kinetic energy of flexible manipulator system is due to motions of joints and links. 
The kinetic energy for a revolute joint if considered as mass with rotary inertia about 
the axis of revolution, is given by, 


Tjoint, — 


( 2 . 29 ) 


where mh, and Ihj are the mass and inertia respectively of hub at joint j 
Pj : position vector of joint j with respect to base frame 
: angular velocity of joint j 

To calculate the kinetic energy due to flexible link we consider the kinetic energy of a 
differential mass (brij, on link j of the manipulator which can be written as: 


dTiinki 


2 ^ 




( 2 . 30 ) 


Kinetic energy of an elenaent % on link j is given by: 




d^?^ /*! 


( 2 . 31 ) 


For constant material density pj and area of cross-section Aj, the above ej .pression can be 


rewritten as: 


2 Iznkj i 




( 2 . 32 ) 


where rrij is the mass per unit length for jth link. As assumed for slender beam the total 
kinetic energy of the flexible link j can be found as: 




dr? \ ^ / drS 


( 2 . 33 ) 


where n,- is the total number of elements into which link j is discretized. 



Potential Energy 


The potential energy of flexible manipulator is considered due to axial and transverse 
deformation of links. Elemental potential energy due to axial deformation of a link is given 
by: 

'duji{x,ty ^ 




QXji 


dx 


72 


(2.34) 


where Ej and Aj are the Young’s modulus of elasticity and area of cross- ection of link j 
respectivly. 

Elemental potential energy due to transverse deformation is given by: 




1 

2J0 




dx% 


dXji 


(2.35) 


where Ij is the area moment of inertia about neutral axis of link j. 

Total potential energy of jth link due to axial and transverse deformation : 




duji(x,ty 


dxji 


dXji "f" 


t' F T 


dx 




(2.36) 


2.2.6 Application of Lagrange’s Equation 


The dynamic equations of motion are obtained by using the Lagrangian formulation of 
dynamics. The general form of Lagrange’s Equation can be written as: 


dt v^qy dq dq 


(2.37) 


where T and V are total kinetic and potential energies of manipulator respectively and q 
is a vector generalized joint angular displacements and flexible deformation variables. Q is 
generalized force vector. 

After application of Lagrange’s equation we get dynamic equations of motion in the 
following form: 

Mq+f(q,q) + Kq = Q (2.38) 


where 

M : Generalized Mass Matrix 

4) : Vector of nonlinear functions of q and q 
K : Generalized Stiffness Matrix 


2.2.7 Damping of the Manipulator 

In a flexible manipulator system, damping is present in several possible forms. Depending 
on the sources, damping can be classified into the following three groups: 



1. Structural damping - Due to flexibility of manipulator arms, energy is dissipated 
within the arm material, that leads to structural damping. 

2. Viscous damping/Coulomb damping - This is caused by the friction present at the 
joints and within the actuator. 

3. Air-resistance - External effects, particularly air resistance to the arm motion causes 
the damping in the manipulator system. 

An equivalent damping factor can be considered to model all of the above stated effects 
'(Thomson 1983). Now damping matrix can be found by the following relation; 

C = q;M -H /5K (2.39) 


where the constants a. and ^ are given by: 


a 




‘^niCa) 


OJ: 


n2 




ni 




2(Wn2C2 ^niCl) 






(2.40) 


(2.41) 


a.jLJLv .1 and are the first and second undamped natural frequencies and and 


'n2 “'ni 

where and w 

^2 are respective damping factors. The damping factors are determined experimentally by 
measuring the decrement in the link vibrations, however this method does not take into 
account the joint and actuator friction. After finding the damping matrix C the modified 
equation of motion for a damped system is written as: 


Mq + Cq-Ff(q,q) + Kq = Q 


(2.42) 


2.2.8 Hybrid Damping 

Proportional damping, as discussed in previous section is widely used in modelling as it 
is quite straight forward to incorporate into the model. However, there are few problems 
faced by this model as discussed below: 

1. The fact, that quite a few applications demand for the lightweight of the flexible 
manipulator links, discourages the use of metallic links. With the development of 
composite materials, manipulators made of composite laminates have come out as a 
viable alternate. However, composite materials exhibit non proportional damping. 

2. In the case of coulomb damping the equivalent damping factor is a function of the 
amplitude of oscillations, leading to nonlinear system model (Eraser and Anthony 
1991), thereby making the linear control design difficult. 



To avoid the above stated problems a hybrid damping scheme is proposed (Bhattacharya, 
Vidyashankar and Tomlinson 2000). Hybrid damping refers to the combined passive damp- 
ing and active damping strategy. In current Avork, a strain dependent passive damping is 
proposed. It has been found that ceremic and ferromagnetic coatings yield significant 
damping over a wide range of frequency. The vibrational energy in these alloys is dissi- 
pated through magneto-elastic coupling. During vibration, the coatings of such materials 
undergo a change of strain, initiating a movement of magnetic domains thereby dissipating 
the mechanical energy through hysteresis. It is observed that ferromagnetic materials show 
high damping at low strain levels (around 50-100 /r-strain) only, however for structural 
vibration control, induced strains are often at least one order higher in magnitude. Hence, 
if only ferromagnetic material is used the extent of damping achieved may be negligible. 
Therefore an active damping scheme is employed to limit the induced strains to low level 
in the passive damping coating. Smart magnetostrictive material layer like the Terfenol-D 
(Bhattacharya, Vidyashankar and Tomlinson 2000)is used to achieve active damping in the 
links. Usually smart materials, in the form of point actuators, are used to control the vibra- 
tions. However with the advent of magnetostrictive composites, such material can be used 
as distributed layer over the links to introduce distributed control of vibration. A series 
of closely packed coils enclose the magnetostrictive layer through out the hnk length. By 
driving the required current, a distributed active strain is generated in the magnetostrictive 
layer. 

Model 

A typical laminated composite link is shown in Figure 2.4. In general the link is made up of 
Hi layers or plies along with a layer each of magnetostrictive material and passive damping 
alloy. 

Y,v 

A / Magnetostrictive layer 


Host layers 

►X, u 

Passive layer 



Figure 2.4: Laminated composite beam with embedded active and passive damping layer 




Prom laminated beam theory, the total strain in terms of displacements is given by, 

du d‘^v 
dx ^ dx^ 

where 

y : Distance from the neutral axis 

u, V : Mid-plane displacements along X and Y axes respectively 



Elemental Strain and Loss Factor Calculation 


Elemental strain in ith element of the jth link may be written in matrix form as: 


] 


Fi{x) 0 0 ^2(2:) 0 0 

0 Hi{x) H^ix) 0 Haix) H^ix) 


,(4-1) 0 f( 6 -f) V 




q,,(i)(2.44) 


Since strain in an element is varying linearly with the distance along X-axis, the average 
strain in an element is taken as the mean of the strains at the two nodes. After solving we 
get: 

^j,i — Y “ %,i) 

b L ‘i 

Next, the strain value calculated, may be used to determine the loss factor for passive layer 
{r}p) by using the strain vs damping data (Bhattacharya 2000). A typical curve showing 
relationship between material loss factor (for Fe-16Cr-4Al material) and strain is shown in 
Figure 2.5. The loss factors for host layer (77/1) and magnetostrictive layer {r}m) are kept 
constant and equal to 0.001. 




Strain xlO"^ 


Figure 2.5: Material loss factor in passive damping layer as a function of strain 




Modification in Elemental Stiffness Matrix 


As each of the link is made up of a number of layers of different mater als, the various 
material properties vary as we move from one layer to other in transverse direction. Hence 
various elements of stiffness matrix get modified. The modified elemental stiffness matrix 
is calculated in the following manner; 

First we calculate the equivalent flexural rigidity for complete link thickness as: 

A /“*'+» -i 

El = 2_^ / QiiWt^dt (2.46) 


where 

w : Width of the link 

t ; Distance of a layer from the neutral axis 

rji : Loss factor corresponding to the ith layer , 

m : number of layers 

Qn : First diagonal element of the stiffness matrix in the stress-strain relationship for 
an orthotropic lamina referred to an arbitrary axis (Agarwal and Lawerence 1990). 
is calculated for each layer in the following manner: 


• For magnetostrictive layer 


and 

Em = (1 + Vmj)Em (2-47) 

where 

I'm ■ Poisson’s ratio for magnetostrictive material 

rjm ■ Loss factor for magnetostrictive layer 

Em ■ Modulus of elasticity for magnetostrictive material 


• For passive layer 


and 

Ep = {l + T]pj)Ep (2.48) 

where 

Up : Poisson’s ratio for passive material 

7?p : Loss factor for passive layer 

Ep : Modulus of elasticity for passive material 



• For Host layers 


^11 = Qh cos^ 'ipi + 2(Qi 2 + SQee) cos^ ipi sin^ 'ik + Q 22 sin^ V'i (2.49) 


where 


ipi : the angle which the principal material axis of an orthographic lamina makes with 
the reference coordinate frame. 

Qk? O 21 J Qkj ^66 elements of the stiffness matrix in the stress-strain 

relationship for a two dimensional orthotropic case (Agarwal and Lawerence 1990) 
and are calculated as: 


Qii = 


Qn ~ Q21 ~ 


E\ 
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TlU. 


TL 


nr^TL 
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22 — 


En 




LT^TL 






and 


Ej< — E\.{\ -f- Tjfij) 


where 

El and E^ : Elastic modulii in the longitudinal and transverse direction respectively. 

i/ij, : Major Poisson ratio, giving the transverse strain caused by the longitudinal 
stress 

Virp : Minor Poisson ratio, giving the longitudinal strain caused by the transverse 
stress 

Gij- : Shearing modulus associated with the axis of symmetry. 

In addition, for calculation of stiffness matrix elements corresponding to axial deformation, 
equivalent EA for complete link thickness as: 



(2.50) 


Values of El and EA, calculated by the above discussed procedure, are used while calcu- 
lating the elemental stiffness matrix Kp for a passive damped system. 



Calculation of Active damping 

Active damping matrix is calculated as (Bhattacharya 1997): 
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where Fi and F 2 are given by: 
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where 

trn, irri+i : Distaiiccs of the rnagnetostrictive layer from neutral axis 


(2.51) 


CJ — dffikxCcEffiW 


dm '■ Magneto-Mechanic constant (meter/Ampere) 

ki : Gain of controller 

cc is coil-constant which is calculated as: 

Uc 

cc = , - 1 — 

+ Ar'l 

where 

ric : Number of coils 
w : Width of the link 
Tc : Radius of coil wire 

Once we find the modified stiffness matrix Kp and active damping matrix Ca the mod- 
ified equation of motion for a hybrid damped system is written as: 

Mq + Caq + f(q, q) + K^q = Q (2.52) 

A flow-chart for finding the system time response with hybrid damping is shown in Fig- 
ure 2.6. 




y Fort t initial Vmal 


Re-compute the strain for combined 
system (conidering both passive and 
active damping) and obtain modified 
response 




Figure 2.6; A flow-chart for finding the system response with hybrid damping 










Chapter 3 

Dynamic Model Derivation and 
Simulation of Single-Link 
Manipulator 


In this chapter, first the closed form undamped dynamic equations of motion are derived for 
single-link rigid and flexible manipulators from the formulation given in Chapter 2. Later 
damping is introduced into the model. Proportional and hybrid dampings are considered. 
Finally numerical simulation of this dynamic system is carried out and various results are 
discussed. 


Yo 



Figure 3.1: A schematic of a single-link manipulator 



3.1 Rigid Single- Link Manipulator 

) 

In this section, the dynamic equations of motion for a single-link rigid manipulator are 
derived in matrix form. A single-link revolute joint manipulator is shown in Figure 3.1. 

We assume joint variable= 6] mass of link= M; length of link= L. Prom Equation 2.5, 
the homogeneous transformation matrice is obtained as; 




’ cos 9 

— sin^ 

Lcos 9 


nl = 

sin 9 

cos 9 

Lsin9 



0 

0 

1 

Therefore we can find: 

dnl 

89 

— sin 9 
cos 9 

0 

— cos 9 

— sin0 
0 

—Lsin9 

Lcos9 

0 


(3.1) 


(3.2) 


Using Equation 2.10, assuming all the products of inertia are zero (Fu, Gonzalez and Lee 


1987), we can derive the pseudo inertia matrix J; 

0 0 \ML 
0 0 0 0 

~ 0 0 0 0 
_ 0 0 M 

Then using Equation 2.17, the inertia term is given as: 


(3.3) 


D=Tr 



Substituting values of 



and J from Equations 3.2 and 3.3, we get 


D = 



(3.4) 


Using Equation 2.15, vector of Coriolis and Centrifugal terms is given as: 


h 


1 1 


A:=l m=l 


(3.5) 


Using Equation 2.18, we can obtain the value of hm, therefore 


h = 0 


Substituting in Equation 2.16, final dynamic equation is given as: 

~ML^e = r 

where r is the external torque applied at the joint. 


(3.6) 



o.z i^iexible Single-Link Manipulator 


The dynamic equations of motion for a single-link flexible manipulator are derived us 
finite element discretization model developed in Chapter 2. Lagrangian formulation 
used for deriving equations of motion. Numerical results of simulation of this system < 
presented in Section 3.3 and the effect of damping is brought out. 


3.2.1 Calculation of Elemental Kinetic Energy 

We define the joint and link coordinate system according to Section 2.2.3. Therefore tl. 
position vector of any material point(s) along the neutral axis of link can be expressed wit 
respect to base coordinate system {Xq, lo) as: 


r° = p0 + 7e°r} 


(3.7 


Here pj is a null vector (as joint is at the origin of base coordinate system) and 


IS eiveu 


by 



cos 9 - sin ^ 

— sin 9 cos 9 


(3.8) 


Prom Figure 2.2, local position vector rj is given by: 


{i - 1)Z + Xi + Ui{<c, t) -t- Th 
Vi{x,t) 


(3.9) 


where 

Th ■ radius of joint-hub 

Ui(a:, t ) : axial deformation along X-axds at a distance x and at time t in the ith element 
of link expressed in coordinate frame of link 

Vi{x,t) : flexural transverse deflection along T-axis with reference to neutral axis at a 
distance x and at time t in the ith element of link expressed in coordinate frame of link 
and Ui{x,t) and Vi{x,t) are given as 


Where 


1 _ r 

0 

0 

F2{x) 

0 

u* 

i 1 

0 

1 

Hi{x) 

H2ix) 

0 

H^ix) 

q/iW = [ wi(i) 

Vi{t) 

VXi(t) 

Ui+i{t) 


VXi+i{t) 


Ui{t) : axial deformation along X-axis at ith node of link 

Vi{t) : flexural transverse deflection along Y-axis at ith node of link 

vxi{t) ; flexural slope along Y-axis at ith node of link 

Various shape functions are given as in Equation 2.28. 


(3.10) 


27 



The general expression for kinetic energy due to inertia of joint 

Tjoint = 


(3.11) 


where Ih is the inertia of the joint. Now general expression for kinetic energy of the ith 
element of link 

1 r' rdr^V fdv^\ , 


(3.12) 


we can also write: 


drl _ dq^ 
dt dqi dt 

dr^ dr^ dr^ dr^ dr^ dr^ dr^ 

d6 dux dvr dvx^ ^u^^l dvxJ^i dvxij^i 


(3,13) 


Where elemental degrees of freedom vector is given by 

qi{t) = [ 9 Ui{t) Vi{t) vx^{t) Ui+i(t) Vi+i{t) vx^+i{t) 

From Equation 3.12 and Equation 3.13 the kinetic energy of ith element is found and 
written in the following form 


Tlinki 

Where Mj is a symmetric 7x7 size elemental mass matrix of the following form 

■Mi(l,l) Mi(l,2) ... Mi(l,7)' 

: [Pil« 

Elements of the above mass matrix are calculated as 


(3.14) 


(3.15) 




\dqi,kj 


(3.16) 


Where is the jth element of vector Qj. 

After integration, all the matrix elements are derived and given in final form as: 
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(3.17) 


Ui^l 


(3.18) 



MK1,2) = -1^[7 < 3 -i] 
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(3.19) 

( 3 . 20 ) 

(3.21) 

(3.22) 

(3.23) 

(3.24) 


3.2.2 Calculation of Elemental Potential Energy 

The elastic potential energy of flexible Unk is considered dne to axial and tr^sverse detor- 
-Iln of link. Elemental potential energy dne to axial defomratron rs grven by. 

(3.25) 




I »d i m v.»r. ~io. .< a»ii«i — >« “ «' 

ni(i,t)isgi»enby , . „ , M [ “i 1 (3.26) 

ni(x,t)=[n(s:) J 

Prom Equation 3.25 and Ekjuation 3.26, V« is written as: 
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where 
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Elemental potential energy 


dne to transverse deformation is given by. 

^- = 2P'("T) ’ 


(3.28) 

(3.29) 

(3.30) 



where I is area moment of inertia of link about neutral axis and vi is given by 


Vi{x,t)=[H^{x) H2 {x) Hz{x) H^{x)] 
From Equation 3.30 and Equation 3.31, can be written as 
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L VXi+i J 


(3.31) 


Vti = -[vi VXi Ui+i uXi+i j^Kt, 
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(3.32) 


(3.33) 


where 

12 61 -12 61 

61 4P -61 2P 

P -12 -61 12 -61 

61 2P -61 AP 

Therefore total potential energy of link due to axial and transverse deformation can be 
written in matrix form as; 

V; = 5qJ.Kiq/, (3.34) 

where combined stiffness matrix Ki is given by: 


K4 = 
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0 0 -A 0 0 
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-IS- Y ^ TS- -f 

^ 4/ 0 21 
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0 f 2/ 0 4/ 


(3.35) 


3.2.3 Assembly Procedure 


The total kinetic and potential energies are calculated by adding the elemental kinetic and 
potential energies which involves the assembling of various vectors and matrices. Let n be 
the number of elements into which link is discretized. 


Kinetic Energy 

Reduced kinetic energy of the manipulator link, is given by 

TU = 

= (3.36) 

Here Mj is found by dropping out the term containing second power of flexible degrees of 
freedom (i.e. the term containing from actual elemental mass matrix . This 



dropped out term is assembled separately for convenience in applying the Lagrange’s equa- 
tion in the following step. Thus the reduced mass matrix is obtained by assembling 
the elemental mass matrices M*. For n elements there will be {n -f- 1) nodes with 3 nodal 
degrees of freedom and there is one additional degree of freedom in the form of angular 
displacement. Hence the size of reduced mass matrix before application of boundary 
conditions is [3(n -H 1) -f 1] x [3(n -I- 1) -f 1]. 

q is the generalized variable vector for the link and q/ is its sub-vector which consists 
of flexible motion variables of the link. These are given by: 


q = [ (9 Ui vi vxi . 

■ . Un+l Vn+l VXn+l ] 3(„+i)+i 

(3.37) 

q_f=[ui vi vxi . 

. . Un-^l Vn+l VXn+l j ^n+1) 

(3.38) 


The left out term (i.e. the term containing qJ^P^q^J ) is assembled separately in the 
following manner; 

n 

= (3.39) 

i=l 

We can write the contribution of this term in the total kinetic energy as 

S = qJPqy^^ (3.40) 

Hence total kinetic energy of the manipulator link is given as 

r,« = i (qjM,Uq; + S) (3.41) 

From Equation 3.11 and Equation 3.41 the total kinetic energy of manipulator T is found 

as: 

T = 


where M* is found by including 

Potential Energy 
Potential energy of the link, V is given by 

= iqjK'q; 


i (q^Mri„,q + S)+ 


(q^M*q + S) 


(3.42) 


in the reduced mass matrix of the link ML 


link" 


(3.43) 



Here q/ is given by Equation 3.38. K* is the stiffness matrix of size 3(n + 1). We define 
K, which is obtained by adding a zero row and column to K*, as; 


K = 


0 ... 0 

: K* 

0 


(3.44) 


Thus total potential energy of the manipulator is rewritten as: 

V = iq^’Kq (3.45) 

where K is the global stiffness matrix. The size of stiffness matrix before application of 
boundary conditions is equal to that of mass matrix, i.e. [3(n + 1) + 1] x [3(n + 1) + 1]. 


3.2.4 Boundary Conditions 

We assume that link is clamped rigidly with the actuator hub at the joint, therefore any 
displacement at node 1 of this link is constrained. This boundary condition is included into 
the model by setting the all flexible degrees of freedoms at node-1 to zero, i.e. 


Ui = 0,Vi = 0, vxi = 0 (3.46) 

These nodal degrees of freedoms are eliminated from the generalized variable vector q. 
Thus final q of size 3n -f 1 is given by: 

q=[0 U2 V2 VX2 ... Un+l VXn+l (3.47) 

Consequently mass and stiffness matrices are reduced by trimming the corresponding rows 
and columns. 


3.2.5 Application of Lagrange’s Equation 


The final equations of motions are derived in the matrix form by applying the Lagrange’s 
equation. From Equations 2.1, 3.42 and 3.45 

£ = i (q^M*q + S- q^Kq) (3.48) 

A 

To get dynamic equations we first find and • Here again the term containing 

the second power of variables (i.e. S) is considered separately. Now 


dc 

aq 


q -^q 


5q 


Kq - q^K 


(3.49) 



Therefore 


dt dq 


3n+l 


Tv/r*" I “Ttk/t* I 

M q + q'M + ^ (Qfc-^q + q^qfc 


fc=l 






(3.51) 


Left-out term (5) is considered in the following manner: 
Prom Equation 3.40 


d fdS\ dS 




- 


2 [dt \dqj dq\ 




5 = qJPq/^^ 

= HI (4 ^ 

= [ qJPq/ 0 ... 0 0 0 ... 0 f 9 + 

+ [ 2qJPq^ 0 ... 0 0 0 ... 0 

- [o 


(3.52) 


(3.53) 


Now the term containing the second derivative of general variables (i.e. term containing 9 
in the right hand side of Equation 3.53) is assembled with the inertia term M*q to get the 
final inertia term in the form of Mq, where M is the global mass matrix. 

Rest of the terms (i.e. terms containing up-to first derivative of variables in Equa- 
tion 3.53) are assembled to get the vector f(q, q) of nonlinear terms. 

Now from the Equations 2.1, 3.49, 3.51 and 3.53 the dynamic equations in the matrix 
form are given fis: 

3n+l 


Mq+EUi 


fc=i 




-q - pq‘ 


. 


dq 


q-Kq + f=Q 


Let 




tel 


iq"^q + f(q.q) 


We get the final equation in the form as: 

Mq-hF(q,q) + Kq = Q 


(3.54) 


(3.55) 


(3.56) 


where M is the mass matrix, P the vector consisting of cetrifugal and coriolis forces, K 
the stiffness matrix and Q the force vector and q represents genralized degrees of freedom. 
Now defining a state vector z = [ q q ]^, Equation 3.56 can be re-written in the form: 

_M-MQ-F-Kq] _ 

The above equation gives a system of first order differential equations which can be inte- 
grated to get the time response of the system. 



3.2.6 Damping Matrix 

Prom Equation 2.39 viscous damping matrix can be found by the following relation: 

C=aM + l3K (3.58) 

where the constants a and /5 are given by: 

~ ^mCs) ('o Kn^ 


TI2 ni 


(3.59) 

(3.60) 


where Um and cun^ ^-re the first and second natural undamped frequencies of link and 
Cl and C 2 are respective damping factors 

a;„i and oj^ are found as (Meirovitch 1967): 


1.875^ 


4.694^ 




(3.61) 


In the past study, experimentally determined values of Ci and C 2 (both equal to 0 . 01 ) are 
chosen (Petrie 1995) for the identical conditions. After finding the damping matrix C, the 
modified final equation of motion for damped system is written as: 

Mq + Cq + F (q, q) + Kq = Q (3.62) 

3.2.7 Hybrid Damping 

Various material properties of the hybrid damped links are given in Table 3 . 1 . Prom 
Equation 2.45 average elemental strain in ith element of the link can be written as: 

” 7 ~ - '^^i) (3.63) 

After computing the strain values, the strain vs damping data (Bhattacharya 2000) may be 

used to determine the loss factor for passive layer (tj,). The loss factors for host layer ( 77 ,) 

and magnetostrictive layer (?;,„) are kept constant and equal to 0 . 001 . Once we find the loss 

factor 77 , the equivalent values of EA and El for total link thickness are calculated with the 

help of Equations 2.46 to 2.50. Hence elemental stiffness matrix given by Equation 3.35 

IS modified into the following form to get elemental stiffness matrix for passive damped 
system. 


(3.64) 
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Aluminium 

Terfenol-D 

Fe-Cr-Al Alloy 

Thickness (t) 

0.01 

150x10"® 

150x10"® 

Elastic Modulus {E) 

70 GPa 

35 GPa 

200 GPa 

Density (p) 

270QKg/Tn^ 

9250Kg/m^ 

rOOOKg/m^ 

Poisson’s Ratio {u) 

0.33 

0.25 

0.28 

Loss-Factor (p) 

0.001 

0.001 

(from Figure 2.5) 


Table 3.1: Geometric and material properties of the hybrid damped links 


Physical system parameters 

Value 

Mass per unit of length of link (m) 

4.93 kg/m 

Length of link (L) 

1.0 m 

Hub radius (rh) 

0.02 m 

Hub Inertia (I/,) 

0.0044 kgm^ 

Width of link (w) 

50 mm 

Thickness of link (t) 

10 mm 

Modulus of elasticity {E) 

200 GPa 


Table 3.2: Physical system parameters for single link mainipulator 

Elemental stiffness matrix Kp^ is assembled to get the global stiffness matrix Kp for 
passive damped system. 

Calculation of Active Damping 

Elemental active damping matrix is calculated from Equation 2.51 and assembled to get 
the global active damping matrix Ca- 

Thus calculated values of Kp and Ca are included into the model which gives the 
following djmamic equation for hybrid damped system. 

Mq + Caq + F (q, q) + Kpq = Q (3.65) 

3.3 Results And Discussion 

Numerical simulations of single-link rigid and flexible manipulator dynamics were per- 
formed. All the programs were developed in MATLAB and to solve the system of first order 
differential equations in state space form (see Equation 3.57) MATLAB routine “ode45” is 
used which is based on the 4th and 5th order RungarKutta scheme with adaptive step-size. 
The physical properties of the manipulator are given in Table 3.2. Later to study the effect 
of variation of these parametens, results are obtained with different values of parameters 
which are given in corresponding figures- In all cases considered, a torque is applied at the 
joint and tirae-reponse of manipulator unconstrained link is studied. 



3.3.1 Rigid Manipulator Results 

To study the basic behaviour of the single link manipulator, results for rigid link are 
discussed so that later a comparison can be made with the flexible link manipulator response 
under similar conditions. For the given input torque at the joint, the variation of joint rate 
and angular displacement for rigid manipulator are shown by blue coloured curves for all 
the cases. 

1. Time- Response Under Different Types of Input Torques 

Three types of torques namely sine wave, cosine wave and square wave, of equal peak 
values and frequencies are considered and the time response for each case is discussed 
below. 

Time resp()^s(^ under sine wave input torque is shown in Figure 3.2. The continuously 
varying torque gives rise to a joint rate which again varies along a sine curve with 90 
degrees phase lag with the input torque. It varies between zero and a positive peak 
value (Figure 3.2B). Since the joint rate is positive at all the instants, the angular 
displacement follows a continuously increasing curve (Figure 3.2C). 

Time response under cosine wave input torque is shown in Figure 3.3. The continu- 
ously varying torque causes the joint rate to vary as a sine wave about a zero mean 
position (Figure 3.3B). Due to this alternating joint rate the angular displacement 
varies between zero and a peak value in the form of a cosine wave which is 180 degrees 
out of phase with input torque. 

Time response under square wave input torque is shown in Figure 3.4. The torque 
variation is sudden and discontinuous. Here we observe a linear variation of joint 
rate with discontinuities at the peak points (Figure 3.4B). However, the joint rate 
remains positive at all instants that gives rise to a continuously increasing angular 
displacement (Figure 3.4C). 

2. Variation in Time Response With Respect to Change in Input Torque- 
Frequency 

Time responses under cosine wave input torque with frequency equal to 1 Hz, 2 
Hz, 4 Hz and 8 Hz are shown in Figures 3.5, 3.3, 3.6 and 3.7 respectively. It is 
observed that due to perfectly rigid link, there is absolutely no effect of frequency 
variation on the basic shape of the time response curves for joint rate and angular 
displacement. However with decrease in frequency i.e. with increase in time period, 
the joint rate and angular displacement varies between peaks of larger magnitude, as 



at lower frequencj' the link gets more time to attain a higher joint rate which in turn 
causes angular displacement to attain larger value. 

3.3.2 Flexible Manipulator Results 

Here in addition to the joint rate and angular displacement, the variation of flexural trans- 
verse deflection and slope at the tip of flexible link are studied with respect to variation of 
frequency of torque, size of meshing, link material properties and slenderness-ratio of link. 
In all the figures flexible manipulator results are shown by red coloured curves. 

1. Time Response Under Diflferent Types of Input Torque 

As in the case of rigid manipulator sine wave, cosine wave and square wave of equal 
peak values and frequencies, are considered and the time response for each case is 
discussed below. 

Time response under sine wave input torque is shown in Figure 3.2. Similar to rigid 
link manipulator case, the joint rate again varies between zero and a positive peak 
value (Figure 3.2B) and gives rise to a continuously increasing angular displacement 
(Figure 3.2C). The effect of link flexibility is observed in the form of zigzag behaviour 
of joint rate and angular displacement variation. However the manipulator still tends 
to follow the basic behaviour of rigid manipulator, shown by the blue coloured curves. 
The transverse deflection and slope, with respect to neutral axis c f link, are shown 
in Figure 3.2D and 3.2E. Both deflection and slope varies along a curve similar to a 
sine wave and is 180 degrees out of phase with input torque. 

Time response under cosine wave input torque is shown in Figure 3.3. In this case 
also there is a smooth variation of torque. However, the input torque starts from an 
initial peak value that acts like an impact for a flexible link. Similar to sine wave case, 
the joint rate and angular displacement tends to follow the rigid link behaviour with 
greater zigzag behaviour as a result of impact for cosine wave (Figure 3.3B and 3.3C). 
Tip deflection and slope vibration show two modes of oscillations. A relatively fast 
mode with high frequency superimposed on a relatively slower oscillatory mode which 
follows a curve 180 degrees out of phase with input torque (Figure 3.2D and 3.2E). 
It is noticed that frequency of fast mode is equal to the natural frequency of flexible 
link, while slower mode has frequency equal to the exitation torque frequency. The 
peak valuffi of deflection and slope are higher than those in case of sine wave. 

Time response under square wave input torque is shown in Figure 3.4. A square wave 
input torque exhibits a sudden change in torque at finite number of points. Due of 
this, joint rate and angular displacement tend to deviate from the rigid manipulator 



Frequency of input torque (Hz) 

Error ratio 

Tip deflection amplitude 

1 

0.050 

1.1 

2 

0.167 

1.1 

4 

0.33 

1.1 

8 

0.98 

1.1 


Table 3.3: Frequency variation results 

response more as compared to previous cases (Figure 3.4B and 3.4C). Deflection and 
slope variation, again show two modes of oscillations with slower mode follows a curve 
180 degrees out of phase with input torque (Figure 3.4D and 3.4E). In addition, the 
amplitude of deflection and slope variation is dependent on the amount of sudden 
change in input torque, which is clear from the comparison of vibration-amplitudes 
between time intervals 0 to 0.5 and 0.5 to 1.0 seconds. 

2. Variation in Time Response With Respect to Change in Input Torque- 
Frequency 

Time resj)ons(\s under cosine wave input torque with frequency equal to 1 Hz, 2 Hz, 
4 Hz and 8 Hz are shown in Figures 3.5, 3.3, 3.6 and 3.7 respectively. To study the 
effect of frequency variation on angular displacement at the joint, error ratio is found 
by the following formula: 


error ratio = 


amplitude of deviation from rigid manipul ator angular displacement 
amplitude of angular displacement of rigid manipulator 


Error ratio at time instant Tp/4 (where Tp is the time period of input torque) is found 
at all frequencies and axe given in Table 3.3. It is found that with the increase in the 


frequency of input torque error ratio in angular displacement increase. However the 
tip deflection and slope remains unaffected by the variation in input torque frequency. 
The high frequency mode oscillations are observed as the zigzag pattern in the tip 
deflection and slope variation. Non-dimensional amplitude of tip deflection is found 
for each frequency by following relation and given in Table 3.3. 

amplitude of tip de fiction variation 

non - (Umensionaltipdefletion amplitude = thickness of link 


3. Variation in Time Response With Respect to Change in Number of Ele- 
ments - Convergence Test 


To ensure the convergence, results are obtained for different mesh sizes and the results 
axe compared. Time responses under cosine wave input torque with frequency of 


Material 

E {GPa) 

E/p (mVsec") 

Error ratio 

Tip deflectior amplitude 

Steel 

200 

20.31 

0.167 

l.i 

Aluminium 

70 

25.13 

0.130 

3.2 

CFRP 

300 

130.44 

0.057 

0.8 


Table 3.4: Material properties variation results 

2.0 Hz and with total number of elements equal to 2, 3, 4, 5 and 6 are compared. 
Angular diplaceraent and tip deflection response with increasing mesh size is shown 
in Figure 3.8. It is observed that with the increase in meshing the change in the 
response for consecutive mesh size values is lesser. Hence the model is converging. 

4. Performance of Link Materials Having Different Modulus of Elasticity and 
Density 

Performanci' of manipulators having link made up of Aluminium, Steel and Carbon 
Fibre Reinforced Plastic (CFRP) Laminates is compared. Time responses of the same 
are shown in Figures 3.9, 3.3 and 3.10 respectively. 

Error ratio at time instant t = 0.125 sec is obtained and given in Table 3.4. It is 
observed that error ratio in angular displacement reduces with increase in specific 
modulus of chusticity [E/p] (Figure 3.1 lA). Therefore material having higher specific 
modulus of ehisticity i.e. CFRP shows the smoothest angular displacement variation. 
Tip deflection amplitinhi is found to be independent of link material density and 
decreases uniformly with increase in the modulus of elasticity (Figure 3.11B). 

5. Variation in Time Response With Respect to Change in Slenderness Ratio 
(L/T) of Link 

Time response of links with lengths equal to 2.0 meters, 1.0 meters and 0.5 meters 
are shown in Figures 3.12, 3.3 and 3.13 respectively. The thickness of link is kept 
constant in all the cases. Error ratio at time instant t = 0.125 sec is found and given 
in Table 3.5. With longer link, the effect of flexibility is more pronounced on the joint 
angular motion as observed by the increase in the error ratio in angular displacement. 
However the fraiuency of the zigzag pattern in angular displacement (Figure 3.12C) is 
less for longer link as natural frequency of a beam is inversely proportional to square 
of the length of beam. Similar response is observed in the tip deflection and slope 
variation. Tip deflection amplitude is found to be increasing with length of link, as 
shown by Table 3.5. 



Link length L (m) 

Error ratio 

Tip deflection amplitude 

2.0 

0.944 

5.0 

1.0 

0.167 

1.1 

0.5 

0.028 

0.3 


Table 3.5: Slenderness ratio variation results 


Resonant Frequency (wr)(Hz) 

FYom Petrie (1995) 

FVom Simulation Results 

First 

4.93 

5.01 

Second 

14.21 

. 14.61 

Third 

30.16 

30.24 


Table 3.6; System resonant frequencies 

6. Time Response With Proportional Damping 

Firstly the response of an undamped and damped single link manipulator of very 
small thickness under a sine wave input torque are shown in Figures 3.14 and 3.15 re- 
spectively. In Figure 3.16 the r^ult from an earlier work (Petrie 1995) with identical 
parameters is shown. The simulation results in Figure 3.15 are found to be in agree- 
ment with the experimental results in Figure 3.16. Further a linear model is obtain 
by dropping out the second power term of elastic variables (i.e. S) in equation 3.48 
and system resomant frequencies are calculated, which are given in Table 3.6. 

It is observed that the proi)orlional damping is able to damp-out the link vibrations 
effectively and the result obtained matches with the given results in Figure 3.16. In 
all the results presented above the damping of joint angular motion is considered. 

In Figure 3.17, results for similar manipulator without any damping of joint motion 
is shown. In c-omparison with ri^d link response it is shown that in the latter case 
link follows the rigid manipulator behaviour far more closely than earlier cases, which 
is desirable from practical applications point of view. 

In Figure 3.18, results for manipulator with physical parameters given in Table 3.2, 
without any damping of joint motion is shown. On comparison with undamped 
and rigid link response with same input parameters (shown in Figure 3.3), again it 
is observed that the proportional damping is able to damp-out the link vibrations 
effectively. Logarithmic decrement in tip slope variation is calculated by taking the 
natural logarithm of the ratio of one amplitude to that of the next amplitude of the 
same and is equal to 0.2231. 
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Figure 3.2: Time response under sine wave input torque 
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Figure 3.3: Time response under wine wave input torque 
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Figure 3.5:' Time response under cosine wave input torque of frequency=1.0 Hz 
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Figure 3.8; Variation of output variables with number of elements 
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Figure 3.10: Time response of a CFRP link manipulator 
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Figure 3 . 15 : Time response of manipulator with damping including the damping of joint 
motion 
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Figure 3.16: Time response result from an earlier work (Petrie 1995) with identical param- 
eters as in figure 3.15 



Tip Deflection of link (v) (In meters) 


Input Parameters 



(A) Time (In seconds) 




— Flexible 

— Rigid 


Mass per unit length=1 .1 7 Kg/m 
Length of the link=1.00 m 
Radius of Hub=0.02 m 
Joint lnertia=0.0044 Kg-sqm 
Width=0.10m 
Thickness=0.0015 m 

Modulus of Elasticity=2.000000e+01 1 N/sq m 
Number of elements=2 
Frequency of input torque=1 .00 Hz 


C/3 




Figure 3.17: Tiiiu; response of manipulator with damping and no damping of joint motion 
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Figure 3 . 18 : Time response of manipulator with damping and no damping of joint motion 






Chapter 4 


Dynamic Model Derivation and 
Simulation of Two-Link Manipulator 

In this chapter, first the closed form undamped dynamic equations of motion are derived 
for two-link rigid and flexible manipulators from the formulation given in Chapter 2. Later 
damping is introduced into the model. Proportional and hybrid dampings are considered. 
Finally numerical simulation of this dynamic system is carried out and various results are 
discussed. 

4.1 Rigid Two-Link Manipulator 

In this S('ction, tin' dynamic eciuations of motion for a two-link rigid manipulator are derived 
in matrix form. A twu-link ixivolute joint planer manipulator with flexible arms is shown 
in Figure 4.1. In th(> case considered, both the links are of equal length, i e. 

Lr=L, = L (4.1) 

With th<? lu'lj) of Fciuations 2.17 and 2.18, we can find the inertia matrix and vector 
n-presciit in;', coriulis and centrifugal forces. The two terms arc calculated in Appendix A 
and final resuit.s are given as: 

Inertia U'rnr. 

r I Ml /A -i- -{MtfJ + cos 02 cos 02 

[ ■ h^MM>-¥^^M2V^cos02 \M2L'^ 

Coriolis and Ctuitrifugal terms: 

sin 020i - sin 02^1^2 

\M2L^sm020i 





where 9i and ^2 art* the joint angles. 




Figure 4.1; A schematic of a Two-link manipulator 

Substituting in Equation 2.16, final dynamic equation is given as; 

-f cos Bz iMzP + cos Bz 1 [ 1 

+ ^yMzL‘\-.oiiOz iMzL^ J [ 02 J 

F - i Ma sin 02 ^ 2 ^ sin 0201 02 

sin 0201^ 

where rj and ra are external torques applied at joint 1 and joint 2 respectively. 

4.2 Flexible Two-Link manipulator 

The dynamic eciuations of motion for a two- link flexible manipulator are derived using finite 
element discretization model as developed in Chapter 2. Lagrangian formulation is used 
for deriving the equations of motion. Numerical results of simulation of this system are 
presented in Si'ction 4.3 and the effect of damping is shown. 

4.2.1 Calculation of Elemental Kinetic Energy 
Link-1 

We define the joint asul link coordinate system according to Section 2.2.3. Therefore the 
position vector of any matcirial point(s) along the neutral axis of link-l can be expressed 
with respect to biuse (;oordinate system {Xo, Eo) as : 



r? = Pi + 


(4.5) 



Hero p‘/ is a null vc'cior (as joint 1 is at th(^ origin of base coor(linat.(; system) and 7^'/ is 
given by 

cos 6i — sin 0i 
- sin 6*1 cos 6i 

From Figure 2. '2. the local position vector r} is giv('n by: 




(4.6) 


{i ~ l)/i + Xi^i + Ui^i{x, t) + r/i 

t) 


(4.7) 


where 


(;r, t) : ('longation deformation along AVaxis at a distance x and at time I in the ith 
element of link expressed in coordinate frame of link 1 

■ llexiireal transverse' deflection along ij-axis with reference to neutral axis at 
a distance x and at time' f. in the ith. ('lenient of link e'xpreissed in coordinat.e frame of link 1 
and Ui^i{x,f.) anel t>i,i(x,,t) are given as 


1 


. Vij{xJ.) _ 



Fi(.r) 0 0 F2(x) 0 0 

0 //,(:r) lUx) 0 Ih{x) //,(:i;) 


q/..,(0 ('bs) 


and 


<4/i,.(^) = [ ''h,i-t-i(0 vxi^i.i-iit.) \ 


T 


Whore 

'Ui,i(t) : axial deformation along A'l-axis at ith node of link 1 

vi^i{t) : flexural transverse deflection along Ij-axis at ith node of link 1 

vxi^i{t) : flexural slope along I'l-axis at ith node of link 1 

Various shape functions are given as in Equation 2.28. 

Substituting in Eejuation 2.29, the expression for kinetic energy due to inertia of joint 1 
is given by: 

Tjointi = 2^hi0i (4-9) 

where is the joint inertia of joint 1 . 

Now genera! expression for kinetic energy of the ith element of link 1 

f / ftli I , 


riinki^i — 2 J 


/ dr J \ / dr? \ 

^ da:i i 

\ dt J \ dt ) 


( 4 . 10 ) 


we can also wriK;: 

dt\ _ c)ri c?qi, 

di dt 


^ll hi. 


dr° 


qi,> 


UBi ^ 111,1 ^vt^i dvxi^i+i 

Where elenu'utal degrees of freedom vector is given by 

qi,.(t)=[0i “I,i(0 "i,i(a »a:i,((«) Ui,i+i(t) ]' 


( 4 . 11 ) 


ar\ 



From Equation 4.10 and Equation 4.11 the kinetic energy oiith element is found and 
written in the following form 

(4.12) 

Where Mi,; is a symmetric 7x7 size elemental mass matrix of the following form: 


M,,,- = 


Ml, ,(1,1) Ml,, (1,2) 

Ml, ,(2,1) 


Mi,i(l,7) 


[PiJg. 


6x6 


Ml,, (7,1) 

Elements of the above mass matrix are calculated as 


7x7 


(4.13) 




' dv\ 


dxi^i 


(4.14) 


Where q,,,,, is the jUi olemcmt of vc'ctor qi,,. 

After integration all th(^ matrix c'k'iuents are derived and given in final form in Ap- 
pendix B. 

Similarly to calculate the elc'nu'nl,al Kinetic energy of link 2, we can write the posi- 
tion vector of any matcuial point (s) along the neutral axis of link 2 with respect to base 
(‘oordinate syst('m (.Vo, K)) as : 

r2 = P■"^-7^2^2 (4.15) 

Where 


and is giv<'n by 


where 


plj = p'l+n^pl 




•^1 + Wi.tip 


'TZ}\ 


n\R\ 


7^ 


cos 0-2 - sin O 2 

- sin O 2 cos O 2 j 


k = B2 + vxx^tip 

From Figure 4.2, local position vector is given by: 


(4.16) 

(4.17) 


(4.18) 

(4.19) 



(* - 1)^2 + X2,i 4- U2,i(x, t) 

V2^{x,t) 


(4.20) 


where 

tr 2 ,i(a;, t) : elongation deformation along X 2 -axis at a distance x and at time t in the ith 
element of link c.xprt^.Nst'd in coordinate frame of link 2 



' 02,1 (a:, t) : flexural transverse deflection along 1^-axis with reference to neutral axis at a 
distance .r and at time t in the zth element of link expressed in coordinate frame of link 2 
and W 2 ,j(;r,t) and V 2 ,i(x,t) arc given as 


' U2A-f'J) ' 


FAX) 

0 

0 

Fzix) 0 

0 



L 0 

Hi(x) 

Hzix) 

0 HAx) 

HAx) . 


(4-21) 


and 


q/2,.(0 = [ V2,i{t) VX2,i{t) U2,i+l{t) V2,i+lit) 


( 4 . 22 ) 


Where 


U 2 .i{t) ■ axial deformation along Xi-axis at ith node of link 2 

V 2 ,i{t) : flexural transverse deflection along IKi-axis at ith node of link 2 

vx 2 ,iit) : flexural slope along Yi-axis at ith node of link 2 

Various shape functions are given as in Equation 2.28. 

Now general expression for kinetic energy of the ith element of link 2 


rh 


T, 


link'z.i 


m2 


dr^V ( drS' 




dt J 


dt 


dX2,i 


(4.23) 


W(' can also write: 


dt 




f>q2,i 

dt 









J!lL. 

arij 



dtl 


-] 


()(fi 



Ovxiiip 

d4 

dOi 

drl 

dU2J 

ar« 

SrO 

q2,t 

- 


. . . 

dV2,i 

dvX2,% 

du2^i4-l 


dvX2,i4'l - 



Where (dement.al degr(K^s of freedom vector is given by 

iT 

CliAf) ~ [ ^2 U2,i V2,i VX2^i U2,i+l '^2.^1 VX2,i^l J 

FYom Fkiuation 4.23 and Equation 4.24 the kinetic energy of ith element is found and 
written in tiie following form: 


'^linh,. = ^q2.iM2,iq2,i 

Where!: M-^.t is a svmuK'tric 11 x 11 size elemental mass matrix of following form 
M2.^(1,1) ••• M2.i(l,5) ... Ma,i(l,ll) 


(4.25) 


M 


2,i 


; M2,i(5,5) ... M2,i(5,ll) 

LM24(11.1) M2,i(ll,5) 


(4.26) 


IXasll 



And olonicnts of tin' al)ov(‘ mass matrix aro calcnladxl as 




,0 \ 




Wlu'rc' is lh(' Jill {'h'liK'iil of vacfor (jo,/- 

Aft('r int<'‘<ratioii all the matrix ('leuK'iits an' di'rived and giv(>ii in final form in Ap- 
pendix B. 

4.2.2 Calculation of Elemental Potential Energy 

Link-1 

The (dastir potential (mergy of fh'xible link 1 is due to axial and transverse deformation of 
link. Elenu'utal potc'utial (uuugy du(^ to axial deformation is giv(ui by: 

where Ei aiul .4i are Young’s modulus of elasticity and area of crcjss-scction for link 1 and 
is given by 


U--I )- 1 a(.a 0(.r) J f A'' 


From Ecpiation -l.'iS and hhiuatioii 1.2!), y,, _ is writU'ii as: 


where' 


‘l-,., K,„„ [„“ A _ 


Jo [ ~/f _ 

[1 -1 1 


(4.29) 


(4.30) 


(4.31) 


Fh'uu'ntal poie'utia! energy due to trausvewse deformation is given by: 

'-'H IK. ) 

where li is area mome'tit of inertia of link al)out neutral axis and Wpj is given by 


[ HiU) //,{r) //i(:r) ; 


VXij 
i'-tl.i- 1 



From E(|iiali<)n !.‘‘i2 and Idjiiation L.'j'F 1/, , can l)c written as 




wlu’ri' 


/•;,/ 


I ‘ I 


‘h., 


r-l 


''l./ • 1 

I'-n.n 

' ] K-.,. 

12 

b/l 

-12 ()/, 

ti/, 

■1/i 

-(i/i 2/r 

^ 12 

(i/, 

12 -(1/ 

b/, 

2/1 

-()/, d/r 


>'\.i 

I'-n., 

''i,i 1-1 

I, rt I J 


(4.da) 


'riu'n'fui'e tDial ixitential ('iH'rgy of link chu' to axial and transv('rs<' dnldnmitiou can Ix' 
writ t ('ll in matrix form as: 


Ti,, = 


wlu'ix' combined stiffm'ss matrix A'i,( f^iven by: 





■ A, 

0 

0 

-A, 

0 

0 

E, 

0 

0 

IMi 

h 

li/i 

h 

4/i 

0 

0 

_iia 

1 

h 

liii 

/i 

2/i 

h 

-A, 

0 

0 

Ai 

0 

0 


0 

12/1 


0 

12/i 

oil 


‘If 

h 

k 

h 


0 

HIx 

h 

2/, 

0 

6/i 

h 



(4.37) 


Link-2 


Similar to link 1 . t he total potential ('in'rgy of link 2 duo to axial and transverse deformation 
can b(' writti'ii in matrix form as: 


9 ^/a.i 

where combined stilfiu'ss matrix h\i is given by: 


Au 

0 

0 

-A, 

0 

0 

0 

12 fa 

IT 

C,h 

h 

0 

1 1 

Mz 

h 

0 

h 

Ah 

0 

2h 

■A, 

0 

0 

A2 

0 

0 

0 

_i4Ai 


0 

Ml 


If 

h 

h 

h 

0 

!iZi 

h 

2h 

0 

^§Il 

h 

Ah 


wIk'ix' 

E-i ■ 'Voimg’s modulus of c'lasticity for link 2 

i'l'i : Area of cniss-section for link 2 

E : Area moment of inertia of link 2 about lu'utral axis 


(4.38) 


(4.39) 



4.2.3 Assembly Procedure 


The total kinetic and potential energies are calculated by summing the elemental kinetic 
and potential energies which involves the assembling of various vectors and matrices. If rii 
and 712 be the number of elements into which link 1 and link 2 are discretized respectively 
then, 


Kinetic Energy 


Kinetic energy of the jth link, is given by 



(4.40) 


Here is found by dropping out the terms containing second power of flexible degrees 
of freedom (i.e. the terms containing q^. J from actual elemental mass matrix 

Mj- ,-. These dropped out terms are assembled separately for convenience in applying the 
Lagrange’s equation in the next step. Thus the reduced mass matrix of size [3{nj + 

1) + 1] X [3{nj + 1) + 1] is obtained by assembling the elemental mass matrices M*j. 

qj is the generalized variable vector for the jth link and q/^ is its sub-vector which 
consists of flexible motion variables of jth the link. These are given by: 


Link-1 


q, = ^ 0^ Vi^i VXi^i ... ^l,ni+l Wi,ni +1 ] 

q/, = [ W, 1,1 Wi,i vxi^i ... i;i,ni+i vxi^m+i ] 


3(ni+l)+l 


3(ni+l) 


(4.41) 

(4.42) 


Link-2 

q.j, = VXi^iip 62 U2,i V2,l VX2,i ... U2,n2-t-l ^gnj-t-l ]3(n24-l)+5 

(4.43) 

T jT 

q /2 = [ W2,l V2,\ VX2,l ... ■Ua.na+I V2,n,+1 ( 4 . 44 ) 

Aft(ir finding f.h(^ kinetic energy for each link, the total kinetic energy of manipulator links 
Tiinkn in found by summation, i.e. 






(4.45) 



Here q is the generalized variable vector for the manipulator and is given by 


q2 



Vij VXi^i ... 

d'z ^2,1 


1 ^ 

^2,1 • • • '^2,7224*1 "^1,722 + 1 '^^1,^241 . 3(72 i 4722+2) + 


is reduced mass matrix of size [3(ni + ^2 + 2) + 2] x [3(ni + n .2 + 2) + 2] and 
is found by ass<'tubling the mass matrices for the two links. The left out terms (i-e- the 
terms containing Q/j .PgiQ/i ^ and q/ 2 iP 2 ,iq/ 2 ,) assembled for each li n k separately in 
the following manner: 



(4.46) 


We can write the contribution of all these terms in the total kinetic energy as; 


Prom Iink-1 

*^1 = 

Prom link- 2 

3-2 = q/2P2q/2(^2 + 20i'ya;Tij+i 4- 20] 02 + 202va;„i+i + 02 ) (4.48) 

Hence total kinetic energy of the manipulator links is given as: 

= i (q'’M;„j.q + Si + S 2 ) (4.49) 

From Equation 4.9 and Equation 4.49 the total kinetic energy of manipulator T is found 
as: 


■^link "b joint 
1 

2 
1 


(q'^ML^,q + 5i + 52) + i4]0i 
(q’^M^q + Si+ S 2 ) 


(4.50) 


Potential Energy 

Potential energy of the jth link, Vj is given by 




1=1 


(4.51) 


Here q/, and q/j are given by Equation 4.42 and Equation 4.44. is the stiffness matrix 
of size 3(nj + 1) x 3(nj + 1) for jth link. We define Ky, which is obtained by adding a zero 



row and coin 


Thus total pc 




N 
CP 

^09 3 
h 09 (0 


01 

h09 


06 


0 




AxlCblil pulator is rewritten as: 


Vj = 

JLf 


(4.52) 


(4.53) 


Therefore total potential energy of the manipulator is given by: 

^ = E^'cjK.q, 

i=i 

where K is the global stiffness matrix of size [3(ni + n 2 + 2) + 2] x [3(n2 + n 2 + 2) + 2] 
before application of boundary condition 


4.2.4 Boundary Conditions 

We assume that link 1 is clamped rigidly with the actuator hub at the joint 1, therefore 
any displacement at node 1 of this link is constrained. This boundary condition is included 
into the model by setting the all flexible degrees of freedoms at node 1 to zero, i.e. 


= 0,ui,i = 0,U2;i,i = 0 


(4.55) 


Same is true for link 2 as here we assume that base end of link 2 is rigidly attached with 
joint 2, therefore 

U2,i = 0, U2,i = 0, ua:2,i = 0 (4.56) 

These nodal degrees of freedoms are eliminated from the generalized variable vector q. 
Thus final q of size 3(ni + ^ 2 ) + 2 is given by: 



'^1,2 '^1,2 '^^1,2 ■■■ ... 

... 02 U2,2 V2,2 VX2,2 ... U2,n2+1 ^’l,n2+l 


T 




3(ni4-n2)+2 


Consequently mass and stiffness matrices are reduced by trimming the corresponding rows 
and columns. 


4.2.5 Application of Lagrange’s Equation 

The final equations of motions are derived in the matrix form by applying the Lagrange’sequation. 
Prom Equations 2.1, 4.50 and 4.54 

£ = i (q’'M*q + Si + S 2 - q^Kq) 

(:6t:V:. 


(4.57) 



To get, dynamic (Hiuations wc first find and . H('rc again I ho terms containing 


‘-!k li 

the second ixnvcr of variahics (i.c. ^S'l and S-j) iire considc'n'd separately. Inow 


And 


Tln'n'fon’ 


(I <)C 
(II aq 


i)C I 

yfq ~ 2 


.y-C^NI , -j, 

q -^q ~ ^^q - q 






Mq-^q M + ^ -^q^- 


k^A 


:i(//i t np) f 2 


A ' 1 


L(>ft-out terms (.S’l and Ah) an' considc'ring in tin' following maniu'r: 
From ecination d.-lT, 


- q';;P,qy,dr 


(4.59) 


(4.(10) 


(I /i)SA ihs', 
(I I V dq ) i)q 


t! ( 0 

- ['// \dq 


(<i/;Pn/.»i)) - y ('if 


- ( q},P,q;, 0 ... 0 0 0 ... 0 ]"'()] + 
i I 2q};p,q^, 0 ... 0 0 0 ... 0 ]''(), - 

n iPiq/.l'" 0 ... 0 


iT 


yf 


Similarly the e.'vpre.shioti for ), 


1 

A / 'l 



ill h ' A J 

;*7q ^ 


(4.61) 

is foimtl ont which is giv(’n in Appendix C. 

Now the t(‘rms containing the s('cond derivative of grnieral variables (i.e. terms contain- 
ing fi|. e.V„, . 1 or /i; in right hand sidi' of Equation 4. Cl and Equation C.l to Ecpiation C.6) 
an' asseml)l('d with the inertia t('rm M*q. to get tlie final inertia term in the form of Mq, 
wiu'n' M is tin* giubat mass tnatrix. 

Hest (if tin terms (i.e. ti'rms containing iip-to first derivative of variables in Equa- 
tion 4.01 tind C.l to (Kination C.(i) are a.s.sc!mbled (for both links) to get the vector f(q, q) 
of nonliiKiar tc'nns. 

Now from (he Ecimitions 2.1, 4.58 and 4.00 the dynamic equations in the matrix form 
are given tis; 


M'l ' L ('1‘ j - -^<1 - 


(4.62) 



(4.63) 


Let 


I t 112 ) 


We get th(' linal ctiuatiou in tin' fonn as: 


rdM\\ l.rOM*. , 

/ q _ q + f,; 


dq 


Mq + F(q,q) + Kq = Q 


(4.64) 


where M is tin' mass matrix, F flu' vector consisting of cetrifugai and coriolis forces, K 
the stiffiK'ss matrix and Q th(^ force v(‘ctor. q is tin* genralizcd degrees of freedom vector. 
Now defining a state' vector z — [ q q Equation 4.64 caii be re-written in the form: 


M~1[Q - F - Kq] 


(4.65) 


Tlu' above (XiUHtion gives a system of first order differential equations which can bc' inte- 
grated to get. tin' tinu' n'spons(' of tlu' system. 

4.2.6 Damping Matrix 

From Equation 2.39, N'iscons damping matrix can b(' found by the following relation: 


C -= oM + ,iK 

when' the const mils n and .) arc given by: 

1 Cl ■ ^/iiC2) 

^n\ 


li - 




^712 ^ 71 } 


(. 1 . 66 ) 


(4.67) 


(4.68) 


where .u.-,,, and and are the first and second undamped natural frequencies and Ci 
and C'i resi>ective damping fa<‘tors. In the curn'nt work, values of both Ci ‘tnd (2 are 
ecmal to i).t)l. -M'ter iinding the damping matrix C the modified final equation of motion 
is writtc'u as: 

Mci f- Cq -h F(q, q) + Kq = Q (4.69) 

4.2.7 Hyi)ri(l Damping 

Various mati'ri; 1 damping properties of the hybrid damped links are given in Table 3.1. It 
is noted tliat usually this dami>ing is highly dependent on the strain. Prom Equation 2.45 
average I'lemental strain in if/> element of the J7/i link may be written in matrix form as: 


1 


-2.> 


'J L 




/ 


(4.70) 



Next, the' .slfain valiK' <'alfiilai(‘<i, may Ix' used lo (l(‘l(‘i'm!ue tlu' loss factor Hu’ passive layer 
by usiiiy the strain vs dainpinj^ data (Bliatlacharya 2000). The loss factors for host 
hm'r (///,) and mae.netosi riel iv(' layer (//,„) aiv kept, constant, and ('c|nal to 0.001. 

Once \v(' li id the loss factor values, the e<juivalent valtu's of ii . 1 and KI for total link 
thickiu'.ss are (alcnhited with tlu' help of Kcpiat ions 2.-l(i to 2.50. Ih'iicc' ('h'lnental stiffness 
matrix yiven by Ibjnalion 1.07 is modilii'd into the f()llo\vin,ii; h)rni to yet. eh’inental stilfiu'ss 
matrix of liidv j Ibi- passive danipi'il system. 
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(.1.71) 


Calculation of Active Damping 


Elcnicutal active damping matrix is cakmlatc'd from Eciuation 2.5i and assembled to get 
the global active damping matrix. 

Thus calcnhit.ed vahu's of K,, and C„ are included into the model which gives the 
following dynamic ('(luatiou for hybrid dam])e(l system. 


Mq + C„q -b F(q, q) + K,q = Q (4.72) 


4.3 Results And Discussion 

Fcjr a two-link nuinii)ulator th(' mnm*rical simulations are carried out by developing a MAT- 
LAB code' and “ode45" routine is used to numerically integrate the system of first order dif- 
ferential equations (stnt Etpiat ion 4.G5). The physical properties of manipulator are given in 
Table ‘1.1. Lat(‘r to sHidy tlui effect of variation of these parameters, results are presented 
for differ(mt va!u(*s of t hese parameters which are given in corresponding figures. The time 
responses for fiexihlt* as well as rigid manipulator are discussed together and a comparison 
has he<ni done. In all the cases (exca-pt in Figure 4.C and 4.7) the manipulator is considered 
to l)e in stret(‘hed-out position i.(!. initial angular displacement at each joint is zero. As 
done in case of singh* link manipulator, angular displacement, joint rate, tip deflection and 
tip slope are si.udit'd for each link with respect to the variation in type, frequency and 
actuation point of input torciiuu material properties of links and slenderness ratio of links. 



Physical systoni paranu'tors Yalno 

Mass per iiiiif of h'ligl.h of links (;/;) 7.3i) kti/ui 

h of links (L) 1.0 m 

Hub radius at, joint, i (/•/,) 0.02 m 

Hub IiH'i'tia (//, ) 0.00-M kfiur 

\\‘i<lth of links ((c) 50 vivi 

ThickiK'ss of links (/) 15 vivi 

Modulus of ('lastic.ily (S') 200 GPa 


Talih' 1.1: Physical syst.tnn paranict,('rs hn- Uvo-link inainipulat.or 

1. Time Response Under Different Types of Input Torque 

Time n‘S})ous(‘ under three* t,yp(^s of input, torque namely sine wave, cosine wave 
and sriuari* wave* of ('([ual amplitudt's and fn'Ciuencies, are shown in Figure 4. 2-4.3, 
Figun* d.d-l.o and Figun* 4.8-4.!) resi)ect,ively. In each case time i. (spouse for two 
compl((te cych's of input torciiu* is studied. 

The given t.orcjue is apjjlied at the joint 1 and no torciue is ai)pliod at joint 2. In 
terms of variation of angular displacement and joint rate, the link 1 follows the basic 
behaviour shown by the; single litik manipulator (as discussed in Section 3.3) under 
respect, iv<' input, torciue. In the*, absence of any torque at joint 2, the* variation of 
joint variable* at. this joint is in the reverse direction to that for joint 1. The effect 
of link 2 on the* dynamics of link 1 is notable particularly for sine and square wave 
input toi'ciiu*. with the* d(*cr(*as(* in the* amplitude of variation of joint rate* (for both 
links) for the* second cycle* (sc*(* h'igurc* 4.2B and Figure 4. SB). Ihis is due to the 
fact that, wil.h the* uniform ine-re*a.se (in ne’gat.ive direction) in 62 , the dominance of 
coriolis and e-e*nt,rifugal forceis increase which leads to lowe*r angular acceleration. The 
ellect of fh*.'cibility is obs(*rv(*d in the* form of increasing difference between the angular 
displae-eme'nt and joint rate variation for both links (see Figure 4.2 and Figure 4.8). 

The variat ion of t.ip deflection and tip slope suggests that both the links start to deflect 
in a. direction opposite to the diretetion of rotation of respective link i.e. link 1 deflects 
in th(? negative* direction and link 2 deflects in positive direction at the application of 
input torciiuu However in the case of torques with non-zero initial value (i.e. cosine 
and sciuan* wave input torque ) a small initial deflection towards the direction of 
rotation is noticc'd which dies down within a very short time (see Figure 4.5A,C and 
Figure 4.9A,C). This glitch is attributed to the coriolis force effect of link 2 on the 
tip c)f t in* link 1 which dominates the inertia force of link 2 on the tip of link 1 
during this small time int(!rval. However, as the magnitude of angular displacement 
of link 2 increase's t.he force at the tip of link 1 increases, which results in a deflection 



in negative dinH-lion. This is ('vich'ut from the ahsoiico of any glitch for the ease when 
initial 0-^ is SHl" as shown in I’igiire -hTAT’- 

2. Variation in Time Response With Respect to Change in Input Torque- 
Fi-equency 

Time responses muh'r cosine wave input toixine of ecpial amplitude and with frequency 
e(iual to 1 ily. 2 Hz, ■! Hz and 8 Hz an' shown in Figure -l.JO-i.ll, Figure 4. 4-4.5, 
Figure 4.12-4.13 and Figun' 4.14-4.15respo('tively. 

It is ohs('rv<>d that, for the increasing frequencies, the variation of angular displacement 
at each joint, dcicremstvs as with lower time period, each link gets lesser time to rotate 
in one particular direct ion. Now since Q-i is rc^stricted to a smaller value for the higher 
fn'(jueuci('s, t,h(' ('ffech; of the link 2 on the dynamics of link i is less. Therefore for each 
high freepunKW ease', both the links tend to maintain the amplitude of variation of 
joint, rat,(' as well as of angular (lisj)lacem(nit for t,he second cycle, which earlier showed 
a decreasing behaviour at low frequencies. The joint variables for flexible manipulator 
follows the rigid manipulator more closely at higher frequency. However the vibratory 
nature in the joint rate, due to flexural vibrations in the flexible links, is more and 
more visible for higher frequency cases. This causes the angular displacement of 
fh'xible manipuhitor t,o chndate at the peaks at higher frequencies. Tip deflection and 
t.ip slope vary similarly for different freciuency casc.s. 

3. Performance of Link Materials Having Different Modulus of Elasticity and 
Density 

'rinu' n'spunses under cosim; wave input toiximi of eciual amplitude for the manipula- 
tors having links made up of Aluminium, Steel and CFRP are shown in Figure 4.16- 
4.17, Ihgurt' 1. 1-4.5 ami Figmx' 4.18-4.11) rc'spectiv(!ly. 

It is observed that tlu' Aluminium and CFRP links manipulator with their low mass 
(hmsitics show high angular disi)lacemeuts and joint rates because of their low inertia. 
Also, siiicx' link 2 is allowed to rotate to larger vahu’s of 02, the effect of link 2 on the 
dyuami<’S of link 1 incixmses and in both these* cases the variation of joint rates at both 
jehnts shows decreasing amplitude for seicond toixpie cycle (sec Figure 4.i6B,C and 
Figun* 4.18.B.(')- With this angular displacement variations arc no longer sinusoidal 
as during tlu* se^cond itqjut torcpie cycle link 2 rotates to such an extent (02 is close to 
the a value* -DO*’) (.sc'i* Figure* 4.1GE and Figure 4.18E) such that the effect of torque 
is in the* n*v(*rse dir(*e:tiou and links continue to rotate in same direction during second 
toixpie* cycle*. 



Th(> ('fi’ccl of vari;i( i<iii of nioduliis of clast irit y is ohscrvcl in the variation of niaxi- 
muni !i[) dclicci ion \-alnc.'.. I'lii' \-aiu(\s of tip deflection and tip slojx' ar(' iiiglK'sf- for 
Aluiniiiiuin links tine to their high flexibility i.e. less modulns of c'last.icity. 

1. Variat ion in I’inio H('sponse With Rospoct to Change in Slenderness Ratio 
(L/T) (!f ranks 

"rimt' rc.spoiiM' with \aiialion in link Iciiiphs e(|nal to 1.') mc(i‘rs, 1.0 incieis and 
().7b nietei's aii' art> shown in h'ignre ■1.20-1.21. Figure •1.-1-1.5 and Figiin' •1.22-1.2.3 
n*sp('c(ivel\' wit It thickness of links reni.iin const ;int.. 

It. is ob.st'fved that, for inanipidatta’ hitving shorter links, tlu' Hide 2 moves t.o higher 
vahit's of tingtdar disjtlacenK'nt (Fignn' -1.220) which in-tnrn gives rise to distorted 
variat ion of angular disphuteuK'nts at both joints. 

However tlj) thtlli'ction and tip .slope are niaxiumin for the longer links of manipulator 
which can be iittributed to the cubic relationslup of deflection with the length of 
links. 

5. Time Response Under Actuation At Both Joints 

Apart from the* cascis di.scussed so far simulation runs arc performed with torque 
at both t.lu' joints. Two ca.s('s, with ('qual torque = 20A’m) and 

U!U'(|ual t.orcpn' ■■ 2l)Nin. and lOiVm) are shown in ^'igur(^ 'l.2-l-'1.2r) 

and Figure •1.26-1.27 respectively. 

It is obs('rved that, with tlu' application of an additional torque at joint 2, the di- 
rection of angular disphuannent of links is governed by this torque i.e. now link 2 
rotates in positives din'tdion and with the effect of that link 1 moves to negative an- 
gular position. Also, for fh'xible links, the vibrations in the joint rate at joint 2 are 
drastically incia'a.sttd howevin- the moan position of these vibrations follows the sinu- 
soidal curv(‘ of rigid manipulator (see Figure 4.24C and Figure 4.26C). The angular 
displac-ement variation patt('.rn at joint 2 is severely distorted due to these vibrations 
(.s'ce Figure 4.2'IF and Figure •1.2CE). 

As (‘xpeett'd both t.he links starts to deflect in the negative direction and no initial 
glitch is o!)served in tip d<‘fiection and tip slope variation. Further the magnitude of 
tip deflection of link 2 is found to be directly proportional to the torque amplitude 
at joiiit 2. 



6. Time Response With Proportional Damping 


In Figure results for luauipulator with j)hysical paraiuet(!rs given in 'Fa- 

ble 4.1, with j)ropoti(>nal (lamping of links is shown. On comparison with undamixKl 
and rigid link rtispoust^ with same input parameters (showm in Figure 4.4-4.5), it is 
observf'd that tlu* projsortional damj)ing is abk^ to damp out the high fnKpiene.y mode 
oscillations in Joint rati; of joint 2 effectively (see Figure 4.28C). However if we com- 
j)are the tip dellectlion and ti]) slope characterictics in above two cases (see Figure 4.5 
and Figun' 4.29), it is observeal that th(;re is marginal decrease in the magnitude of 
oscillations at tip of links with elimination of some peaks. Logarithmic decrement 
in tip slopi; variation of link 1 is found to be equal to 0.3243. However damping is 
not able to (‘liminaie link oscillations completely as done in case of single-link ma- 
nipulator (;as(; and then'fore a better control strategy is required to eliminate tlu^se 
oscillations. 




Input Parameters 


— Flexible 

— Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m ^ 

Joint-1 inertia=0.0044- Kg-m 

Width ofeachlinksO.OSOm 

Thickness of each link=0.01 £ J m 
Modulus of Elasticity=2.000000e+01 1 N/m 
Number of elements in link-1=2 
Number of elements in Iink-2-2 
Frequency of input 



(B) Time (in seconds) 



(D) Time (In seconds) 



l''igur(* 4.2: I'iine response under a sine wave input torque 












Angular Displ^ement of Joint-1 (In radians) Joint rate of Joint-1 (In radians/sec) 
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Figure 4.4: Time response 


Angular Dispiacemenl of Joim-2 (In radiai 


Input Parameters 


Flexible 

— Rigid 


Mass per unit length of iinks=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elastici1y=2.000000e+01 1 N/m" 
Number of elements in rmk-1=2 
Number of elements in link-?~2 
F roquency ol input torcjuo . 2 00 I L' 
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a cosine wave input torque 









Angular Displacement of JoinW (In radians) 



(A) Time {In seconds) 


input Parameters 


Flexible 

Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
! ength of the link~2=1 .00 in 
iTidius of Hub-0 020 m 

Juiiit I lnuitia-0 0044 Kg-ni‘' 

Width of oach lmk=0 050 m 
Ihn;kn( 2 :'.s of each link 0.0 1 50 m 

Modulus of Elasticity=2.000000e+01 1 N/m" 
Number of ele nents in link-1 =2 
Number of ele nents in iink-2=2 
Frequency of input torque=1 .00 Hz 



(B) Time (in seconds) 
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Figure 4.C: Time response with initial Q-i -90° 











Angular Displacement of Joint-1 (In radians) Joint rate of Joint-1 (In radians/sec) Torque at Joints (In Nm) 



Angular Displacement of Joint-2 (In radians) Joint rate of Joint-2 (In radians/sec) 



— Flexible 

Input Parameters j 

— Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 

Modulus of Elasticity=2.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=:2 
1 Frequency of input torqu6=2.00 Hz 




under a square wave input torque 







Tip Slope of link-1 (In radians) Tip Deflection of link~1 (In meters) 



(C) Time (in seconds) (D) Time (in seconds) 

Figiin; 4.1): I’ij) defiectioii and slope variation under a square wave input torque 
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Input Parameters 


— Flexible 

— Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 

Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elasticity=2.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=1 .00 Hz 



(B) Time (in seconds) 
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Figure 4.10: Time response under a cosine wave input torque of frequency=1.0 Hz 
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Input Parameters 


Flexible 

Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1.00 m 
Length of the link-2=1.00 m 
Radius of Hub=0.020 m 

Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elastlcity=2.000000e+011 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=4.00 Hz 




(D) Time (In seconds) 
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Figure 4.12: 'J’ime rtisponse under a cosine wave input torque of frequency=4.0 Hz 
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Fipire 4.13: Tip deflection and slope variation under a cosine wave input torque of fre- 
quency=4.Q Hz 







Angular Di^laoament of Joint~1 (In radians) 



Input Parameters 


Flexible 

Rigid 


Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 

Modulus of Elasticity=2.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=8.00 Hz 



(B) Time (in seconds) 
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(D) Time (In seconds) 



(E) Time (In seconds) 


Figure 4.14: Time response under a cosine wave input torque of frequency=8.0 Hz 
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(C) Time (in seconds) 


(D) Time (in seconds) 


Figure 4.15: Tip deflection and slope variation under a cosine wave input torque of fre- 
quency— 8.0 Hz 





Joint rato of Joint-^l (In r^isn^soo) Torque at Joints (in Nm) 



Input Parameters 

Mass per unit length of rmks=2.02 Kg/m 
Length of the link- 1=1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 !nertia=0,0044Kg-m^ 

Width of each iink=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elasticity=7.000( 00e+0l0 N/m^ 
Number of elements in !ink-l =2 
Number of elements in link-2=2 
Frequency of input torque=2.00 Hz 




(C) Time (in seconds) 
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Fi8„r.. 4.1ft Time reepoue. of. AlrnnU™* mampuletor 
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(A) Time (In seconds) 


Input Parameters 


— Flexible 

— Rigid 


Mass per unit length of links=1 .73 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=:0.050 m 
Thickness of each link=0.01 50 m 
Modulus of Elasticity=3.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=2.00 Hz 
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("igure 4.18: Time response of a CFRP link manipulator 
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Input Parameters 

Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .50 m 
Length of the link-2=1.50 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elasticity=2.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=2.00 Hz 


Flexible 

Rigid 



(B) Time (in seconds) 




Figure 4.20: Tinie response of manipulator having link lengths=1.5 meters 
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Figure 4,21; 'rij} ddiwtioii and slope variation of manipulator having link lengths 1.5 
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Input Parameters I — Rigid 

Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of EIasticity=2.000000e+01 1 N/m^ 
Number of elements in link-" =2 
Number of elements in link-2=2 
Frequency of input torque=2.00 Hz 




(E) Time (In seconds) 


Figtirt* 4.20: Titiu; response manipulator under action of unequal torques at both joints 
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Input Parameters 

Mass per unit length of links=7.39 Kg/m 
Length of the link-1 =1 .00 m 
Length of the link-2=1 .00 m 
Radius of Hub=0.020 m 
Joint-1 lnertia=0.0044 Kg-m^ 

Width of each link=0.050 m 
Thickness of each link=0.0150 m 
Modulus of Elasticity=2.000000e+01 1 N/m^ 
Number of elements in link-1 =2 
Number of elements in link-2=2 
Frequency of input torque=2.00 Hz 
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(C) Time (in seconds) 
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I 'igiiiT 4.28; Turn m\mm of manipiiktor with proportional damping 










Chapter 5 
Closure 


5.1 Summary 

This thesis addresses the problem of modelling and control of flexible manipulators. The 
methods and concepts used in this thesis are of general applicability for all flexible manip- 
ulators. 

In chapter 1, flexible manipulators are introduced and their need and potential advan- 
tages over rigid manipulators are highlighted. Problems associated with modelling and 
control of flexible manipulators are discussed. In the section of literature survey, available 
literature addressing these problems are critically examined. Based on this study our tlusis 
problem is defined and main contributions are presented. 

In chapter 2, a Generalized Lagrangian approach is used for deriving the dynamic 
equations of motion for rigid and flexible manipulators. For flexible manipulator, finite 
element method is used to discretize the continuous system. Proportional damping is 
modelled in the system. A combined active and passive damping is also proposed and 
discussed. 

In chapter 3, single-link flexible and rigid manipulators are modelled and equations of 
motion are derived in matrix form. Simulation results with a number of different input 
parameters are discussed in detail. 

In chapter 4, modelling is carried out for two-link flexible and rigid manipulators and 
their equations of motion are derived in matrix form. Manipulator dynamics is numerically 
simulated and results with proportional damping are examined. 

5.2 Conclusion 

For a single-link manipulator the effect of flexibility is visible in the form of oscillations in 
the variation of angular displacement. These ocsilltions are observed to have the frequency 
equal to the first natural frequency of link. The study of flexural transverse deflection and 
slope at the tip of link suggests that tip deflection and slope variations show two inodes 
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of oscillations. A relatively fast niode with frequency equal to the first natural frequency 
of link is superimposed on a relatively slower oscillatory mode having frequency equal to 
excitation torque frequency. Other important observations are as follows: 

• As shown by results given in Table 3.3, the error ratio in the joint angular dis- 
placement at corresponding points increases (error ratio=0.050 at frequency=l Hz 
to error ratio=0.98 at frequency=8 Hz) with the frequency of input torque, which 
suggests that angular displacement variation is severely affected by oscillations at 
higher frequencies. Tip transverse deflection amplitude remains constant (=1-1) for 
all considered cases vith ferquency varying from 1 Hz to 8 Hz. 

• A comparision in the performance of manipulator links made up of Steel, Aluminium 
and Carbon Fibre Reinforced Plastic (CFRP) laminates is made in Table 3.4 and 
variation of performance with material properties is shown in Figure 3.11. It is 
concluded that for the CFRP, which has maximum specific modulus of elasticity 
{E/p = 130.43x10® A’m/^^), error ratio in angular displacement is least (=0.050), 
while error ratio increases to 0.167 at E/ p = 20.31xl0®7/’m/A:5 for Steel link. Thus 
CFRP manipulator gives the smoothest variation in angular displacement. Compari- 
sion of tip deflection amplitude suggests that it is dependent on the material modulus 
of elasticity only and is not affected by density of link material. Therefore amplitude 
of tip deflection is maximum (=3.20) for Aluminium (i? = IQGPa) while in case of 
CFRP {E = 300GPa) it is least (=0.8). Hence we conclude that specific modulus of 
elasticity {Ef p) is a good performance index of flexible rnaniplator link material. 

• Results with different slenderness ratio (keeping the link thickness constant) are pre- 
sented in Table 3.5. Manipulator having higher link length (=2.0 m) is severely 
affected by flexibility with error ratio in angular displacement=0.940 and tip deflec- 
tion arnplitude=5.0, while manipulator with shorter link (=0.50 m) performs well 
with error ratio=0. 028 and tip deflection amplitude=0.3. 

• Response of a single-link damped manipulator suggests the proportional damping is 
able to damp-out the undesirable vibrations of a flexible link effectively without af- 
fecting the requisite angular displacement. Logarithmaic decrement in the amplitude 
of tip slope is found to be equal to 0.2231. 

In the case of a two-link manipulator, the final equations of motion suggest a highly 
non-linear dynamics, which is well exhibited in all the simulation results. Similar to single- 
link manipulator, the flexibility of manipulator links is visible from the oscillations in the 
variation of angular displacement. Two modes of oscillations are noticed in vibrations of 
tip deflection and tip slope variation. In results with variation of different parameters like 
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nature and freciuency of input torque, material properties and slenderness ratio of manipu- 
lator links, basic similarities were found between single and two-link manipulators, however 
due to high de]:>endence of two-link manipulator dynamics on the angular displacement at 
joint 2 { 62 ), the effect of 6*2 is dominant in all the results. A damped model of a two-link 
manipulator suggests that proportional damping has been able to damp-out the link vibra- 
tions effectively. Similar to the single link manipulator the logarithmaic decrement in the 
amplitude of tip slope of link 1 is found to be equal to 0.3243. However need for a better 
.control strategy is emphasized. 

5.3 Suggestions for Future Work 

Modelling and control are the two fundamental and critical issues related to the develop- 
ment of flexible manipulators. In this thesis effort is made to tackle some of the problems 
associated with flexible manipulators. The suggestions for future work are as follows: 

1. The work can be extended to the cases with planer manipulators having more than 
two links on the basis of general scheme given in chapter 2. 

2. Similar work for flexible manipultors in 3-D will be of great importance form practical 
applications point of view. 

3. A strategy, to model the manipulators having one or more prismatic joints, can be 
developed. 

4. Inclusion of joint flexibility in the model. 

5. Implementation of hybrid damping into the model. 
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Appendix 



Appendix A 


Calculation of Inertia Matrix and 
Vector Representing Coriolis and 
Centrifugal Forces For Two-Link 
Rigid Manipulator 


A.l Calculation of Transformation Matrices 


(Fu, Gonzalez and Lee 1987 ) 

We assume joint variables= ^i, 6*2; mass of links= Mi, M2; length of each link= 1 
equation 2 . 5 , the homogeneous transformation matrices are obtained as: 


7 e° = 






cos(^i 82) 
sin (01 + 82) 
0 


Therefore we can find: 


dn'l 

d8i 


dnl 

ddi 


cos 01 — sin 01 

L cos 01 



sin 01 cos 01 

L sin 01 



0 0 

1' 



cos 02 — sin 02 

L cos 02 



sin 02 cos 02 

L sin 02 



0 0 

1 



— sin (01 4 ~ 82) 

l/(cos( 0 i 4 - 02) -f cos 01 ) 

cos( 0 i 4 - 02) 

Z/(sin(0i 4 " 02) 4 " sin 0i) 

0 


1 

J 

— sin 01 — cos 01 — jL sin 0 

1 

1 


cos 01 - sin 0 

j L cos 01 



0 0 

0 



-cos (01 4-02) 

-L(sin( 0 i -f 02) 4 - sin 01 ) 

- sin( 0 i 4 - 02) 

L(cos( 0 i 4 - 82) 4 - cos 0 i) 


'887 


0 

-sin (01 4-02) 
cos (01 4 " 82) 

0 


0 


0 


■ cos( 0 i 4 - 02) -L sin( 0 i 4 - 82) 

■ sin( 0 i 4 - 02) Lcos( 0 i 4 - 82) 

0 0 


. Prom 

(A.1) 

(A.2) 

(A.3) 

(A.4) 

(A.5) 

(A.(i) 



A. 2 Calculation of Mass Matrix 


Using equation 2.10, assuming all the products of inertia are zero, we can derive the pseudo 


inertia matrix If 


Ji 


J2 = 

Then using equation 2.17, we have 



0 

0 

\MiL 

0 

0 

0 

0 

0 

0 

0 

0 


0 

0 

Ml 


0 

0 

\M2L 

0 

0 

0 

0 

0 

0 

0 

0 


0 

0 

M 2 


D,. = Tr I ^,7. U T. " 


801 ‘V 901 


801 ^ V 901 


dTZ^ 

Substituting values of and Jj from equations A.4 and A.7, we get 

Dn = \MiL^ + cos 0^ 

o o 


Similarly, 


Di2 = D 21 


Tr 




80 , 


^J2 




1 ,, .0 1 


— -tM2L^ + COS O 2 

o Jj 


And 


n 


22 


8'RPo , fdTZ^ 




' 802 V 902 


ON 


1 


MoL^ 


(A.7) 


(A.8) 


(A.9) 


A.3 Calculation of Vector Representing Coriolis and 
Centrifugal Forces 

For j = 1, using equation 2.15, we have 

2 2 

= EE 

k:=zl 7n=l 

= + hu20l^2 hi210l02 + hi2202 (A.IO) 



Using equation 2.18, we can obtain the value of hjkrm therefore 

hi = sin 02^2^ - M^L'^ 

Zt 

Similarly, for j — 2, we have 


2 2 

h-i = ^ ^ h-iknfik^m 

k—l m=l 

= + ^ 212 ^ 1^2 + ^ 221 ^ 1^2 + ^ 222^2 
= iiV/2L^sin020V^ 


(A.11) 



Appendix B 

Mass Matrix Elements of Two-Link 
Flexible Manipulator 

B.l Mass Matrix Elements of Link 1 


Form equation 4.13 the elemental mass matrix of link 1, Mi,i is given in the following form; 

Mi,(1,7) 


M 


1,1 


Mi.i(l,l) Mi,(l,2) 

Mi.i(2, 1) 


[Pm] 


6cc6 


Mi,i(7,l) 

And elements of the above mass matrix of are given as follows: 


7x7 


Pl,^ 


mill 


140 0 0 70 0 0 

0 156 221i 0 54 -131i 

0 22li All 0 131i -Ul 

70 0 0 140 0 0 

0 54 131i 0 156 -22Zi 

[ 0 -13Zi -31? 0 -22li All 


(B.l) 


Mi,i(l,l) = mill 

+ 2m 


Mi,i(l,3) 


Mi,i{l,A) 


Mi,i(l,2) 

mill 


1? ~ 3^ ~ 1) + 

f ill _ li. + i&k] (m — ll rill') 

\2 3 ^ 2 J \2 6 ^ 2 J \ 

mill 


+ ql, Pi.iq/,.. + (B-2) 

(B.3) 


Ui,i 

'^1,1+1 


20 


[7 h 3 -h' 


mill 


Vl,i 

VXi^i 

VXi,i+i J 


2q (10*^1 “ 71i + lOr/i) + [ -13 3 ] 

mil? 


Ul,i 

L J 


(Ml - 31, + 5r») + ^ [ 1 4] 


Ui,i 

L J 


(B.4) 

(B.5) 

(B.6) 





mill 


[ 9 2li 21 3/i ] 


Vl,z 

^^1,2+1 

M.,i(l, 6) = ^ (lOif, - 3i, + lOrJ + ^ [ 17 7 ] 
Mi,(l, 7) = -^ (5ih - 2h + 6r») + ^ [ -2 3 ] 


'^1,2+1 


(B.7) 

(B.8) 

(B.9) 


B.2 Mass Matrix Elements of Link 2 

Form equation 4.26 the elemental mass matrix of link 2, M2,i is given in the following form: 
■ Ms, .(1,1) ... M2,i(l,5) ... Mi,i(l,ll) 

M2.i= ; M2.i(5,5) ... Ms, .-(5, 11) 

PsjtJgxe 

LM2,i(ll,l) ... M,,(ll,5) 

And elements of the above mass matrix of are given as follows; 


P2,i — 
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0 

0 

70 

0 
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0 

156 

22/2 

0 

54 

-13/2 

ms^s 

0 

22^2 

4/2 

0 

13/2 

1 

CO 

to to 

420 

70 

0 

0 

140 

0 

0 


0 

54 

13/2 

0 

156 

-22/2 


0 

-I3I2 

-3/2 

0 

-22/2 

4/i 


(B.IO) 


M2,j(l. 1) = rrh 


where 


h ((-^1 + Ui^tip)^ + + 2AZ2 — 2} ~ ^ 3) 

+ ^2^2 [ (A + j(3i - 2)) B ^ (A + j{3i - 1)) B ] q/2 ,, + 

+ q/2,iP2,iq/2,< (B-11) 

A= {Li+ ui^up) cos §2 + vi^up sin #2 
B = -(Li + ui^tip) sin §2 + vi^tip cos §2 


Similarly 

M 2 , .(1,2) 


-ms/s 
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ui, tip + sin ^2^2 (^“27] 
sin 02 cos 02 sin 02 cos 02 -^^^]q/2„ (B.12) 
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cos 02 -sin 4 cos 02 
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Q/2,i + 

(B.13) 


Mv{l,4) = m2i2[ (41 + 1(3.- -2)) B Sh (^ + |(3i-l)) B -‘f]q/=„ + 


+ m2 


All\i-^ \ -\- ll [ - i -\- 
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M2,i{1.5) = m2i2[ (A+|(3i-2)) B ^ (A+|(3!-1)) B 


H- rn-z 


^^2 ( * - 2) ~ * + 2 


+ q/,. P2,iq/2,, 


(B.15) 


M2,i(l,6) = 21 3/2 0 9 -3^2 ]q/,,, (B.16) 
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(B. 31 ) 


M 2 ,i( 3 , 3 ) = m2l2 
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Appendix C 


Contribution of Term S2 in Final 
Dynamic Equation of Two-Link 
Flexible Manipulator 


Prom equation 4.48 


S 2 = q^2P2q/2(^2^ + 29iVXni+i + 26162 + Pa:^,+i + 202nx„,+i + 62 ^) 

i 

S 2 can be written in the form: 


where 
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